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PREFACE 


During  ihe  Iasi  few  years,  major  scientific  progress  has  been  achieved  in  fields  related  to  computer 
aided  analysis  of  multibody  systems.  In  view  of  this  progress  and  recent  developments  of  computer  hardware 
and  general  purpose  software,  there  is  a  need  to  access  the  current  state  of  art  and  results  from  different  schools 
of  thought,  with  the  objective  of  focussing  trends  in  future  research. 

Going  back  to  1983  when  an  important  NATO-NSF-ARO  Advanced  Study  Institute  on  Computer 
Aided  Analysis  and  Optimization  of  Mechanical  Systems  was  held  at  the  University  of  Iowa,  one  may  notice 
that  less  then  10  years  ago  the  state  of  art  was  mainly  dwelling  on  rigid  body  dynamics. 

The  interest  in  the  dynamic  simulation  of  mechanical  systems  has  steadily  increased  in  recent  years 
coming  mainly  from  the  aerospace  and  automotive  industries.  The  development  of  multibody  system  analysis 
formulations  have  been  more  recently  motivated  with  the  need  to  include  several  features  such  as:  real-time 
simulation  capabilities,  highly  non-linear  control  devices,  work  space  path  planing,  active  control  of  machine 
flexibilities  and  reliability  and  accuracy  in  the  analysis  results. 

The  need  for  accurate  and  efficient  analysis  tools  for  design  of  large  and  lightweight  mechanical 
systetris  has  driven  many  research  groups  in  the  challenging  problem  of  flexible  syaems  with  an  increasing 
interaction  with  finite  element  methodologies. 

Basic  approaches  to  mechanical  systems  dynamic  analysis  have  recently  been  presented  in  several  new 
text  books.  These  publications  demonstrate  that  both  recursive  and  absolute  methods  still  have  their  proponents 
to  resolve  the  redundancy  encountered  in  most  mechanical  systems. 

Al»,  it  is  now  widely  recognized  that  the  classical  equations  governing  multibody  systems  dynamics 
must  be  derived  and  presented  in  a  computer  oriented  manner  using  either  modem  symbolic  manipulators  for 
faster  and  reliable  code  development  or  advanced  assemblage  and  solution  algorithms  interfxing  in  a  modular 
manner  with  other  types  of  software  in  the  areas  of  control,  finite  elements  and  optimization.  These  are  topics 
that  are  addressed  in  a  more  systematic  manner,  using  modem  object  oriented  computer  languages. 

This  ASI  brings  together  developers  of  different  segments  of  these  schools  of  thought  as  lecturers, 
advanced  design  engineers,  and  researchers  as  students,  for  the  purpose  of  presentation,  refinement  and 
publication  of  a  comprehensive  work  on  different  methodologies  in  Computer  Aided  Analysis  of  Rigid  and 
Flexible  Mechanical  Systems. 

Related  developments  and  applications  in  solution  methods  in  the  fields  of  numerical  analysis, 
software  and  hardware  platforms  are  presented  and  analyzed  in  this  ASI.  Recent  contributions  to  lime 
integration  methods  applicable  to  differential-algebraic  systems  and  problems  related  to  time  integration  of 
flexible  systems  with  high  frequency  content  are  also  addre.sscd.  Computer  graphics  and  parallel  computing 
methodologies  using  emerging  computer  technologies  are  presented  and  analyzed  as  an  alternative  to  speed  up 
and  post-process  the  numerical  solution  of  very  large  and  complex  systems. 

In  addition  to  presentation  of  basic  formulations  and  methodologies  in  dynamics  of  multibody  systems, 
numerical  analysis  and  computational  aspwts,  major  applications  of  developments  to  dale  are  presented  and 
analyzed  in  this  ASI.  The  scope  of  applications  is  extended  to  vehicle  dynamics,  aerospace  technology, 
robotics,  machine  dynamics,  vibration,  intermittent  motion  and  crashworthiness  analysis. 

Several  of  these  applications  have  been  explored  by  many  researchers  and  engineers  with  a  constant 
objective  to  pace  development  and  improve  the  dynamic  performance  of  mechanical  systems  avoiding  different 
mechanical  limitations  on  the  deflections  and  dificult  functional  requirements  such  as  for  example,  accuracy  in 
robots.  The  applicational  aspects  of  this  ASI  will  help  the  participants  to  apprize  the  different  approaches 
available  today  and  their  use  and  suitability  as  efficient  design  tools  for  different  classes  of  problems  and 
practical  applications. 

This  ASI  in  the  field  of  Computer  Aided  Analysis  of  Rigid  and  Flexible  Mechanical  Systems  is  quite 
timely  and  it  is  expected  that  through  the  interchange  of  ideas  between  leading  scientists  and  scholars,  well 
defined  directions  of  research  and  developments  will  emerge  as  well  as  an  increase  in  international 
collaboration  and  new  industrial  applications  developments. 

I  deeply  appreciate  all  help  and  cooperation  in  organizing  the  Institute  given  by  Prof.  Jorge  A.C. 
Ambrdsio.  1  am  gratefull  to  all  members  of  the  organizing  committee  and  to  Prof.  C.  A.  Mota  Soares,  for  their 
sup^rt  and  advice.  Special  thanks  to  CEMUL  staff,  Ms.  GIdria  Ramos,  Ms.  Alexandra  Andrade,  and  Mr. 
Amandio  Rcbcio  for  their  effort  and  constant  support  of  the  Institute 

Tr6ia,  June  1993 


Manuel  Seabra  Pereira 
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Abstract.  The  concepts  of  twist  generator,  wrench  generator  and  their  counterparts, 
namely,  twist  annihilator  and  wrench  annihilator  are  introduced  in  this  paper.  It  is  shown 
that  twist  annihilators  allow  the  elimination  of  idle  variables  in  the  analysis  of  kinematic 
chains  with  mtiltiple  loops,  thereby  easing  the  formulation  of  the  underlying  kinematic 
relations.  As  examples  of  applications,  the  input-output  velocity  analysis  of  a  four-bar 
spatial  linkage  and  the  Jacobians  of  a  robotic  mechanical  system,  pertaining  either  to  a 
walking  machine  or  a  multi-fingered  hand,  are  included. 


1  Introduction 

The  relatioiu  among  the  joint  rates  of  simple  kinematic  chains,  i.e.,  chains  with  links  coupled 
to  two  other  links  at  most,  have  been  fully  researched  for  some  time,  Pioneer  work  in  this 
regard  was  reported  by  Freudenstein  (1962),  who  Introduced  the  closur''  equations  of  a 
single-loop  spatial  kinematic  chain  as  a  linear  combination  of  the  screws  associated  with 
the  axes  of  the  kinematic  pws  involved,  the  corresponding  coefficients  being  the  joint 
rates.  Hence,  the  underlying  differential  relations  can  be  written  in  the  form  of  a  matrix 
that  Freudenstein  called  the  functional  matrix  of  the  chain.  This  matrix  is  formally  ideiitical 
to  the  Jacobian  matrix  of  robotic  manipulators  with  open  kinematic-chain  structure  of  the 
simple  type. 

Current  developments  in  robotic  technology  have  prompted  the  study  of  multi-loop, 
mvdti-degree-of-ireedom  kinematic  chains.  Such  kinematic  chains  appear  in  robotic  sys¬ 
tems  like  parallel  manipulators,  walking  machines  and  multi-fingered  hands.  The  difference 
between  kinematic  chains  with  multiple  loops  and  open  kinematic  chmns  with  a  simple 
structure,  e.g.,  those  occurring  in  serial  manipulators,  is  the  presence  of  a  number  of  idle 
joints  in  the  former.  The  feed-forward  control  of  the  associated  robotic  mechanical  systems 
requires  an  explicit  relation  between  the  actuated  joint  rates  and  the  Cartesian  velocities 
of  the  system.  This  relation  is  known  to  be  linear,  the  coefficient  matrices  involved  being 
genetically  termed  Jacobians.  While  in  serial  maniptilators  one  single  Jacobian  appears, 
the  presence  of  multiple  loops  brings  about  two  global  iicohiaas,  one  multiplying  the  vector 
of  joint  rates,  the  other  the  twist  of  the  controlled  link.  Here,  a  distinction  should  be  made 
between  what  we  understand  as  a  global  and  a  focal  Jacobian.  The  former  refers  to  one  per- 


1 


taining  to  the  overall  'anematic  chun,  while  the  latter  to  a  particular  subchaiu  of  the  given 
chidn.  In  simple  kinematic  chains  this  lUstinction  is  immaterial,  but  in  multi-loop  chains 
it  is  essential.  \Miile  the  derivation  of  the  Jacobian  of  robots  with  serial  kinematic-chain 
structute  is  a  well-established  subject,  that  uf  the  Jacobiams  involved  in  multi-loop  systems 
is  still  a  research  subject. 

Here,  we  resort  to  the  concept  of  screw,  already  discussed  by  Ball  (18  ’’il,  to  derive  the 
desired  relations.  The  approach  to  the  analysis  of  kinematic  chains  usua^y  encountered 
in  the  literature  involves  the  calculation  of  reciprxKal  screws.  Any  screw  multiplied  by  an 
amplitude  with  units  of  angular  velodty  yields  4i  twist.  If  tue  screw  is  multiplied  by  an 
amplitude  with  units  of  force,  a  wrettck  is  obtuned.  If  a  pven  screw  produces  a  wrench 
on  a  body  moving  with  a  twist  produced  by  a  second  screw  and  the  first  wrench  develops 
zero  power  onto  the  body  under  the  aforementioned  twist,  the  two  screws  are  said  to  be 
reciprocai  A  study  on  the  duality  between  wrenches  and  twists  in  the  context  of  reciprocal 
screws  and  its  impact  in  the  analysis  of  serial  and  parallel  robotic  manipulators  was  recently 
reported  (Samuel,  McAree  and  Hunt,  1991;  Waldron  and  Hunt,  1991).  Here,  we  show  that, 
resorting  to  the  concept  of  twist  annihitator,  not  only  one,  but  rather  a  set  of  linearly 
independent  reciprocal  screws  can  be  readily  derived. 

Applications  of  the  concepts  introduced  here  are  anticipated  in  the  area  of  hybrid  or 
kinetostatic  (open-loop)  control  of  manipulators.  In  this  regard,  our  work  can  complement 
that  reported  by  Lipkin  and  Duffy  (1985,  1988). 

2  Background  on  Screws  of  Lower  Kinematic  Pairs 

We  focus  here  on  the  screws  associated  with  lower  kinematic  pairs,  i.e.,  pairs  coupling  rigid 
links  via  surface  contact,  as  opposed  to  coupling  via  point  or  line  contact,  which  occurs 
under  Aiy/ier  kinematic  pairs  (Hartenberg  and  Denavit,  1964;  Angeles,  1982).  The  six  lower 
kinematic  pairs  a'e  the  revolute  pair  (R),  the  prismatic  pair  (P),  the  screw  pair  {H),  the 
cylindrical  pair  (C),  the  spherical  pair  {S)  and  the  plarMr  pair  {E),  a  description  of  which 
can  be  found  in  the  above  references. 

We  start  by  recalling  the  Plucker  coordinates  of  a  Unc  C,  defined  as  an  array  of  she  real 
numbers,  namely,  the  three  components  of  t  unit  vector  e,  parallel  to  C,  and  the  three 
components  of  its  moment  about  a  predefined  point  O  that  can  b'e  inside  or  outside  the 
line.  If  P  is  a  point  of  £,  and  p  is  the  vector  directed  from  0  to  P,  then  the  moment  n  of 
the  line  is  defined  as 

n  =  pxe  (1) 

Moreover,  the  Plucker  array  of  the  line  is  defined  here  as  a  six-dimensional  array  nc ,  namely, 

^C=[l]  (2) 

Note  that  the  six  entries  of  the  Plucker  array  are  not  independent,  for  they  must  obey  two 
conditions,  namely, 

e-e  =  l,  and  e-ir  =  r'  (3) 

Thus,  the  Plucker  array  of  a  line  contains  only  four  independent  components,  but  these 
are  enough  to  define  the  line.  Now,  if  a  pitch  p  is  added  as  a  fifth  feature  to  the  line  or. 


(4) 


correspondingly,  to  its  Piuclcer  array,  we  obtain  a  screw  t,  namely, 

-f  \  1 

[pxe  +  pej 

An  amplitude  is  any  scalar  A  multiplying  the  foregoing  screw.  It  produces  a  twist  or  a 
wrench  depending  on  its  units.  The  twist  or  the  wrench  thus  derived  can  be  said  to  be 
in  canonical  form,  for  its  representation  involves  explicitly  the  eight  parameters  defining 
it,  namely,  the  amplitude,  the  pitch  and  the  six  Pludcer  coordinates  of  the  associated  line. 
Clearly,  a  twist  or  a  wrench  are  defined  completely  by  six  independent  -real  numbers.  More 
generally,  a  twist  can  be  regarded  as  a  6'dimensional  array  defining  completely  the  velocity 
field  of  a  rigid  body  and  comprises  the  three  components  of  the  angular  velocity  and  the 
three  components  of  the  velocity  of  any  of  the  points  of  the  body.  The  wrench  can  be 
regarded  likewise,  namely,  as  the  6-dimensional  array  defining  completely  the  resultant  of 
a  system  of  forces  and  moments  acting  on  a  body.  Once  the  twist  is  defined  so  that  its  first 
three  components  are  those  of  angular  velocity,  the  wrench  should  be  defined  with  its  first 
three  components  being  those  of  the  resultant  moment  involved.  If  we  denote  by  u  and  v 
the  angular  velocity  and  the  velocity  of  a  point  P  of  the  body,  while  letting  n  and  f  denote 
the  moment  and  the  force  acting  on  the  body,  the  latter  applied  at  point  P,  then  the  twist 
t  and  the  wrench  w  are  defined  as 


Note  that  the  wrench  has  been  defined  so  that  the  inner  product  t^w  will  produce  power. 


3  The  Twist-  and  Wrench-Transfer  Formulas 


The  twist-transfer  formula,  which  relates  the  twist  of  the  same  rigid  body  at  two  different 
points  is  now  derived.  Here,  we  will  need  the  cross-product  matrix  of  a  3-dimensional  vector 
V,  which  is  a  3  X  3  matrix  V.  For  any  3'dimensioaal  vector  x,  V  is  defined  as 


a(vxx) 

dx 


(6) 


which  can  be  readily  proven  to  be  skew-symmetric.  Indeed,  from  the  above  definition,  the 
cross  product  v  x  x  can  be  alternatively  written  as 


V  X  X  =  Vx 


Moreover,  the  product  Vx  vanishes  whenever  x  is  a  multiple  of  v,  and  hence,  V  is  singular. 
Moreover,  from  the  above  relation, 

x^Vx  =  0 

for  arbitrary  x.  Now,  the  foregoing  product  can  only  vanish  if  V  i)  is  a  proper  orthogonal 
matrix  rotating  vectors  through  90®  about  any  axis,  or  if  ii)  V  is  a  multiple  of  the  afore¬ 
mentioned  orthogonal  matrix,  or  if  Hi)  V  is  skew-symmetric.  However,  V  being  singular, 
the  first  two  possibilities  arc  ruled  out,  and  hence,  V  is  skew-symmetric,  q.  e.  d. 


Now.  let  A  and  P  be  two  arbitrary  points  of  a  ri^d  body.  The  twist  of  the  body  at 
these  points  is  defined  as 


where  vp  can  be  rewritten  as 

vp  =  vx  +  (a  -  p)  X  u»  (8) 

with  a  and  p  defined  as  the  position  vectors  of  points  A  and  P,  respectively.  Combining 
eq.(7)  with  eq.(8)  yields 

tp  =  Tt^  (9) 

with  the  6  X  6  matrix  T  defined  as 


.=  f  1  o] 

-[a-p  ij 


in  which  the  3  x  3  matrices  A  and  P  are  the  cross-product  matrices  of  vectors  a  and  p, 
respectively.  Moreover,  1  and  O  denote  the  3x3  identity  and  zero  matrices. 

Likewise,  the  wnnch-iramfer  formula  relates  the  wrench  at  two  points  on  the  same  rigid 
body.  We  define  the  wrench  at  these  points  as 


Aytl  fnp' 


where  n/>,  the  moment  of  the  wrench  about  point  P,  is  related  to  that  about  A,  w^,  by 

np  =  nyi  +  (a-p)x  f  (12) 

and  hence,  wp  takes  on  the  form 

wp  =  Uw^  (13) 

where  U  is  the  6  X  6  matrix  defined  below: 
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and  A  and  P  were  defined  in  eq.(9).  Thus,  wp  is  a  linear  transformation  of  w^. 

Multiplying  the  transpose  of  each  side  of  eq.(9)  by  the  correspondmg  side  of  eq.(13) 
yields 

t?wp  =  tjT^Uw^  (15) 

Upon  expansion  of  the  matrix  product  appearing  in  eq.(15),  we  obtain 


with  16x6  denoting  the  6  x  6  identity  matrix.  Hence,  tjwp  =  tjw^,  as  expected,  since 
the  wrench  develops  the  same  amount  of  power,  regardless  of  where  the  force  is  assumed  to 
be  applied.  Also  note  that  an  interesting  relation  between  T  and  U  follows  from  eq.(16), 
namely, 

U-*  =  (17) 

It  is  apparent  that  both  det(T)  and  det(U)  are  equal  to  unity.  Thus,  the  twist  and 
the  wrench  at  two  different  points  of  a  rigid  body  are  related  by  a  linear  transformation 
represented  by  a  6  x  6  matrix  of  the  unimodular  group,  i.e.,  the  group  of  6  x  6  matrices  of 
determinant  equal  to  unity. 
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4  The  Twist  Generators  of  the  Lower  Kinematic  Pairs 

We  define  below  the  twist  generators  of  the  six  lower  kinematic  pairs: 

4.1  The  Revolute 

A  rcvolute  coupling  of  two  ri^d  links,  1  and  2,  appears  in  Fig.  1,  which  shows  its  attributes, 
namely,  a  line  C,  passing  through  point  0  and  parallel  to  the  unit  vector  e.  The  screw  of  the 
revolute,  denoted  by  the  6-dimensional  array  sa,  is  derived  from  the  general  expression  for 
the  screw  given  in  eq.(4)  with  a  pitch  p  =  0.  Moreover,  we  let  p  denote  the  vector  directed 
from  point  0  of  £  to  point  P  of  body  2.  The  screw  ap,  then,  takes  on  the  form 

•«=U%] 

Note  that  the  foregoing  array  is  identical  to  the  Plucker  array  of  C.  when  written  with  a 
moment  about  point  P.  In  this  case,  since  any  motion  of  2  with  respect  to  1  reduces  to  a 
rotation  about  £  with  point  0  of  2  coincident  with  point  O  of  1,  the  twist  of  2  with  respect 
to  1  can  be  simply  expressed  as  0sa,  and  hence,  sa  is  the  twist  generator  of  this  pair. 


Figure  1;  The  revolute  pair 


4.2  The  Prismatic  Pair 

A  prismatic  pair  coupling  bodies  1  and  2  is  shown  in  Fig.  2,  its  sole  attribute  being  the 
direction  of  the  unit  vector  e.  Here,  no  line  can  be  defined,  as  in  the  case  of  the  revoiute, 
the  associated  screw,  %p,  being  given  as 

.P  =  [°]  (19) 
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Thus,  any  motion  of  2  relative  to  1  reduces  to  a  translation  along  the  direction  of  e,  the 
associated  twist  thus  reducing  to  b»p.  The  twist  generator  of  the  prismatic  pair  is,  then, 

Sp. 


Figure  2:  The  prismatic  pmr 


4.3  The  Screw  Pair 

Shown  in  Fig.  3  is  a  screw  pair  coupling  bodies  1  and  2,  its  attributes  bmng  a  line  C  and  a 

pitch  p.  Moreover,  the  line  is  defined  by  its  direction  parallel  to  the  unit  vector  e  and  its  * 

moment  about  point  P  of  body  2.  The  derivation  of  the  associated  screw,  from  eq.(4), 

is  straightforward,  namely, 

Thus,  any  motion  of  2  with  respect  to  1  reduces  to  a  rotation  about  and  a  translation  along 
line  C,  the  associated  twist  thus  becoming  6»h.  The  twist  generator  of  the  screw  pair  is 
thus  Sff. 

4.4  The  Cylindrical  Pair 

> 

A  cylindrical  pair  coupling  bodies  1  and  2  appears  in  Fig.  4,  which  shows  the  attributes  of  the  ' 

associated  screw,  namely,  the  line  £  and  its  two-dof  capability,  namely,  a  translation  along 
and  a  rotation  about  £,  each  independent  from  the  other.  Thus,  the  reiative  motion  allowed  i 

by  this  pair  has  two  degrees  of  freedom,  the  associated  motion  then  being  a  combination  | 

of  the  motions  allowed  by  a  revolute  and  a  prismatic  pair,  the  latter  having  a  direction  ; 

parallel  to  that  of  the  axis  of  the  revolute.  While  in  the  first  three  cases  the  twist  generator 
coincided  with  the  screw  associated  with  the  psur  at  hand,  and,  hence,  the  twist  generator 
reduced  to  a  d-dimensional  array,  in  this  case  we  need  a  6  x  2  array,  in  light  of  the  degree  of 
freedom  involved.  In  fact,  the  twist  of  any  motion  of  2  with  respect  to  1  can  be  expressed 


1 


6 


Figure  3:  The  screw  pair 


as  a  linear  combination  of  the  screws  of  the  re  volute  and  the  prismatic  pair,  i.e., 


which  can  be  recast  in  the  form 


and  hence,  the  twist  generator  sought  is  the  6x2  coefficient  matrix  Sc  multiplying  the 
two-dimensional  vector  of  motion  variables  [0, 6]^  in  the  above  expression,  i.e.. 


where  0  is  the  3-dimensional  zero  vector. 

4.5  The  Spherical  Pair 

Shown  in  Fig.  5  is  a  spherical  pair  coupling  two  bodies,  1  and  2,  its  sole  attribute  being 
point  0  common  to  the  two  bodies.  Thus,  any  relative  motion  of  2  with  respect  to  1 
maintains  point  0  of  2  fixed  to  point  0  of  1,  the  motion  thus  being  spherical.  A  spherical 
kinematic  pair  can  be  regarded  as  the  combination  of  three  revolntes  in  series,  with  axes 
intersecting  at  point  0.  Let  these  axes  be  parallel  to  the  unit  vectors  eji,  the  associated 
motion  variables  being  Bk,  fori;  =  1,2,3.  Thus,  any  possible  relative  motion  has  a  twist  t 
given  by 


4.6  The  Planar  Pair 


Figure  6  below  shows  a  planar  kinematic  pair,  that  can  be  regarded  as  the  series  combination 
of  two  prismatic  pairs  of  non>parallel  directions,  given  by  unit  vectors  ei  and  e2.  Parallel 
to  these  two  vectors  and  passing  through  a  point  0,  we  can  dehne  a  plane  11,  its  normal 
being  the  unit  vector  es.  Thus,  any  motion  of  2  relative  to  1  has  the  twist 


Alternatively,  the  above  equation  can  be  written  in  the  form 


t 


and  hence,  the  twist  generator  sought  is  the  6x3  matrix  coefficient  of  the  motion 
variables  hi,  and  8,  namely. 


Se  = 


0 

ei 


0  ea 
ej  ea  X  p 


(23) 


5  The  Wrench  Generators  of  the  Lower  Kinematic  Pairs 

The  counterpart  of  a  twist  generator  is  «.  'orench  generator.  We  define  the  wrench  generator 
of  a  lower  kinematic  pmr  as  a  6  X  6  matrix  mapping  an  arbitrary  wrench  into  a  feasible 
constraint  wrench,  i.e.,  a  wrench  acting  between  two  rigid  bodies  coupled  by  the  aforemen¬ 
tioned  lower  kinematic  pair  and  that  does  not  develop  any  power  onto  the  system,  its  sole 
function  being  that  of  keeping  the  two  bodies  together. 
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Let  the  twist  of  the  relative  motion  between  two  bodies  coupled  by  a  lower  kinematic 
pair  be  denoted  by  t.  More  precisely,  we  assume  that  two  bodies,  labelled  1  and  2,  are 
coupled  by  a  lower  kinematic  pair  end  denote  the  twist  of  the  motion  of  body  2  with 
respect  to  body  1  by  t.  Furthermore,  the  point  of  body  2  at  which  the  twist  is  defined,  is 
P,  that  is  arbitrary. 

Moreover,  we  denote  the  constraint  wrench  exerted  by  body  1  onto  body  2  by  wp,  which 
is  defined,  correspondingly,  at  point  P  of  body  2.  That  is,  the  force  of  vp  is  assumed  to 
be  applied  at  point  P.  Furthermore,  the  wrench  acting  on  body  1  due  contact  with  other 
bodies  than  2  and  to  the  environment,  is  denoted  by  A  and  is  comprised  of  a  moment  fi 
and  a  force  v  applied  at  point  0  of  body  1  that  is  defined  as  in  Figs.  1,  3-6.  Now,  since 
bodies  1  and  2  are  coupled  via  a  lower  kinematic  pair,  the  wrench  transmitted  from  1  to  2 
is  not  ail  of  A,  but  a  linear  transformation  of  the  latter,  given  by  the  6x6  matrix  W  that 
we  call  the  itmnch  generator  associated  with  the  pair  at  hand.  We  thus  have 

wp  =  WA  (24) 

Now,  we  call  S  the  6  x  r  matrix  that  maps  the  r-dimensionai  vector  of  motion  rates  9 
associated  with  the  same  lower  kinematic  pmr  into  the  twist  t,  i.e., 

t  =  S9  (25) 

Under  the  assumption  that  the  kinematic  pair  is  conservative,  the  foregoing  wrench  wp 
develops  no  power  onto  body  2,  and  hence, 

w?t  =  0 

Upon  substitution  of  the  expressions  above  for  the  wrench  and  the  twist  into  the  latter 
expression,  we  have 

A^W^Sff  =  0  (26) 

Now,  the  foregoing  relation  should  hold  for  every  value  of  9  and  every  value  of  A,  and 
hence,  we  must  have 

W^S  =  Oer  (27) 

where  Oer  is  the  6  x  r  zero  matrix. 

We  derive  below  the  wrench  generators  for  all  six  lower  kinematic  pairs. 
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5.1  The  Wrench  Generator  of  the  Revolute  Pair 


Let  Wo  be  the  wrench  applied  by  body  1  onto  body  2  at  point  0  of  the  revolute  axis. 
Then,  if  A,  as  defined  above,  is  the  wrench  exerted  by  other  bodies  and  the  environment  on 
body  1  at  the  same  point  0,  the  only  difference  between  A  and  wo  is  the  moment,  which, 
for  the  latter.  Is  /s  minus  its  component  along  the  revolute  axis,  and  hence. 


1  -ee^  Ol 

O  iJlv. 


Now,  in  order  to  have  the  wrench  at  point  P,  all  we  do  is  recall  the  wrench-transfer  formula 
of  eq.(13),  thereby  obtaining 


5.4  The  Wrench  Generator  of  the  Cylindrical  Pair 

Here,  the  difference  between  wo  nnd  X  lies  in  both  the  moment  and  the  force.  That  is, 
the  moment  and  the  force  of  wq  are  those  of  X  minus  the  axial  component  of  the  moment 
or,correspondingly,  of  the  force,  i.e., 

the  wrench  at  point  P,  wp,  now  being  obtained,  as  usual,  by  application  of  the  wrench- 
transfer  formula,  i.e., 

-P(l-ee^)1  f/tl 
O  1-ee^  \[u\ 

Thus,  the  desired  wrench  generator  is  the  matrix  coefficient  of  the  wrench  X  in  the  foregoing 
expression,  namely,  -r 

5.5  The  Wrench  C'—v’  tof  the  Spherical  Pair 

The  wrench  wo  now  contains  only  fo  and  no  moment.  We  can  thus  write 

and  hence,  upon  application  of  the  wrench-transfer  formula,  we  obtain 

from  which  the  wrench  generator  can  be  readily  identified,  namely, 

W.=  [°  f]  (32) 

5.6  The  Wrench  Generator  of  the  Planar  Pair 

In  this  case  the  wrench  wo  has  a  moment  with  zero  component  along  the  normal  to  the 
plane  and  a  force  that  is  normal  to  the  plane.  Thus,  this  wrench  takes  on  the  form 


_  r  1  -  esej  O 
°  [  O  eaej 


and  hence,  the  wrench  at  P  becomes 


.  -  eacj  -Pese^ 


from  which  the  wrench  generator  for  this  pair  is  readily  identified,  i.e.. 


W£:  = 


_ri-e3ej  -PeseJ 
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6  The  Twist  Annihilators  of  the  Lower  Kinematic  Pairs 

A  twist  annihilator  is  defined  here  as  a  6  X  6  singular  matrix  mapping  any  of  the  twist 
generators  introduced  in  Section  4  into  the  6-dimeniional  zero  array.  That  is,  the  columns 
of  the  aforementioned  twist  generator  lie  in  the  nuUspace  of  the  corresponding  twist  anni- 
hilator.  It  should  be  apparent,  then,  that,  for  a  given  twist  generator  there  are  infinitely 
many  twist  annihilators.  We  will  use  the  relation  of  eq.(27)  to  define  the  twist  annihilators 
of  the  six  lower  Idnematic  pairs.  fVom  that  equation  it  is  apparent  that  we  can  choose  the 
twist  annihilator  of  any  lower  kinematic  pair  as  the  transpose  of  the  corresponding  wrench 
generator. 

We  list  below  the  twist  annihilators  of  all  lower  kinematic  pairs. 

6.1  The  Twist  Annihilator  of  the  Revolute 

This  annihilator  is  denoted  by  An  and  is  pven  by 

?]  («) 

Now  it  is  a  simple  matter  to  show  that 

A«8fi  =  0 

where  0  is  the  6-dimensional  zero  vector. 

6.2  The  Twist  Annihilator  of  the  Prismatic  Pair 

The  twist  annihilator  of  the  prismatic  pair  is  denoted  by  Ap  and  is  given  by 

and  hence,  it  is  a  simple  matter  to  show  that 

Aptp  =  0 

6.3  The  Twist  Annihilator  of  the  Screw  Pair 
This  twist  annihilator  is  given  by 

?]  (36) 

and  is  related  to  the  corresponding  twist  generator  by 


want  is  an  expression  between  ij)  and  (j>.  This  expression  is  derived  below  by  relating  first 
the  joint  rates  of  the  serial  manipulator  with  the  twist  of  its  EE,  t,  namely, 

30  =  t  (40) 

where  the  Jacobian  matrix  J,  the  twist  t  and  the  6-dimensional  vector  of  joint  rates  6  take 
on  the  forms 

J  =  f  1  (41) 

ei  X  Pi  *2  X  Pi  *3  x  p2  e<  x  p2  es  x  ps  eexpsj  '■  ' 


=  f*"l 

0  J 


$2  \ 

0=  .  ! 


Thus,  in  order  to  derive  the  relation  sought,  we  have  to  eliminate  the  five  joint  rates 
^2,  ■  •  ■  ,  06  from  eq.(40),  which  is  done  in  two  steps.  In  the  first  step,  we  eliminate  the  joint 
rates  6i,  63  and  64  associated  with  the  spherical  joint  coupled  to  the  input  link.  In  the 
second  step,  we  eliminate  the  joint  rates  associated  with  the  remaining  universal  joint. 

The  first  step  is  straightforward.  All  we  need  is  multiply  both  sides  of  eq.(40)  by  the 
twist  iuinihilator  As  of  the  spherical  joint  of  interest.  From  our  previous  discussion,  this 
annihilator  is  given  by 

?]  («) 

Upon  multiplication  of  both  sides  of  eq.(40)  from  the  left  by  As,  we  have 

A5J0  ss  Ast 


AsJ  = 


0  0 
*  .Cl  X  (n  -  r2)  0  0  0  es  X  (rs  -  r2)  es  X  (rs  -  r2)J 

^"*=[r2Xerl^  (44b) 

and  hence,  we  end  up  with  the  simpler  relation 

ei  X  (ri  -  r2)0  es  x  (rs  - 13)^  +  es  X  (rs  -  =  r2  x  er^  (45) 

Now  it  is  apparent  that  the  two  terms  containing  the  undesired  joint  rates,  6s  and 
63,  will  disappear  from  the  above  equation  if  its  two  sides  are  dot-multiplied  by  the  cross 
product,  k,  of  the  two  vector  coefficients  of  these  joint  rates.  The  desired  result,  namely,  ^ 
expressed  as  a  function  of  rp,  takes  on  the  form 

4>  =  (46a) 


with  K,  N  and  D  defined  as 

k  =  (es  x.(r5  -  r2)J  x  [es  x.(r5  -  r2)l 
•N  =  k  •  r2  X  er,  jD  =  k  •  ei  x  (ri  -  ri) 
thereby  completing  all  derivations. 
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7.2  Jacobian  Matrices  of  a  Walking  Machine 


Now  we  study  the  multi-loop  kinematic  chain  of  a  3-dof  robotic  mechanical  system,  as 
depicted  in  Fig.  8a.  This  figure  represents  either  a  multi-legged  walking  machine  with  three 
feet  in  contact  with  the  ground  or  a  three-iingered  hand  grasping  an  object,  whereby  the 
ground  of  the  walking  machine  becomes  the  object  of  the  hand.  ’From  Euler’s  formula  for 
graphs  (Harary,  1972),  it  is  apparent  that  the  foregoing  kinematic  chain  has  two  independent 
loops  and  three  degrees  of  freedom.  Now,  if  this  system  represents  the  kinematic  structure 
of  a  walking  machine,  the  spherical  pairs  are  used  to  model  the  contact  between  feet  and 
ground  when  no  sliding  is  assumed.  Note  that,  when  one  of  the  legs  is  in  the  swing  phase, 
the  leg  becomes  a  two-dof  serial  manipulator,  and  hence,  it  requires  two  actuators  to  control 
it.  Thus,  one  can  assume  that  each  of  the  revolute  pairs  is  an  actuated  revolute,  and  the 
whole  machine  has  six  motors  but  only  three  dof,  i.e.,  we  have  a  redundantly-actuated 
machine.  We  want  to  derive  a  relation  between  the  joint  rates  of  the  six  revolutes  and  the 
twist  of  the  body,  namely,  the  triangular  plate  shown  in  the  aforementioned  figure. 

Shown  in  Fig.  8b  is  the  kinematic  chain  of  the  Jth  leg,  i.e.,  an  open  chain  composed  of 
a  spherical  pair  and  two  revolutes,  which  can  be  regarded  as  a  serial  manipulator  meant  to 
position  point  C  of  the  EE  (the  triangular  plate)  and  to  orient  the  latter.  In  this  figure  we 
assume  that  the  spherical  pair  is  the  serial  combination  of  three  revolutes  with  concurrent 
axes.  The  leg  is  thus  modeled  as  a  5-revolute  serial  manipulator.  Let  ejk  denote  the  unit 
vector  parallel  to  the  axis  of  the  kth  revolute  and  Bjk  the  associated  joint  variable,  for 
k  =  1, . . . ,  5  and  J  —  I,  II,  I II.  Here,  we  number  with  a  roman  numeral  the  leg  and  with 
an  arabic  one  the  joint  of  a  particular  leg.  Thus,  the  relation  between  the  joint  rates  of  the 
Jth  leg  and  the  twist  of  the  EE  takes  on  the  usual  form 


JjOj  =  t 


(47) 


where  the  leg  Jacobian  Jj  is  a  6  x  5  matrix,  while  Oj  and  t  are  S-dimensional  and  6- 
dimensional  vectors,  respectively,  defined  below: 


h  = 


eji  ej2  ej3  Kjt  cjs 

eji  X  pji  ej2  X  pji  ej3  x  pji  cu  x  pji  ejs  x  p, 
Sji 


:s. 


6j2 


LtfjsJ 


=  [?] 


(48a) 

(48b) 


The  relation  sought  is  now  derived  by  annihilating  the  idle  joint  rates  from  relation 
(47).  This  is  done  by  multiplying  both  sides  of  the  said  equation  by  the  annihilator  of  the 
twist  of  the  spherical  joint,  Asj,  defined  as 


Asj  = 


Rji  1 


(49) 


We  thus  obtain 

[0  0  0  X  (rj4  -  rji)  ejs  x  (rjj  -  PJi)i  =  rji  x  w -f  c 
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If  the  system  under  study  is  redundantly  actuated,  i.e.,  if  the  two  revolutes  are  powered, 
then  the  above  relation  is  all  we  need,  for  that  relation  contains  no  idle  joint  rates.  That 
is,  if  we  let  ^ j  denote  the  2-dimensional  vector  of  actuated  joint  rates  of  the  Jth  leg  and 
Kj  the  associated  Jacobian  of  the  same  leg,  we  have 


where 


=  Asjt 


Kj  =  [ej4  X  itj4  -  rji)  ejs  X  (rjs -rji)] 


Asjt  =  rji  X  w  +  c 


(50) 

(51a) 

(51b) 


On  the  other  hand,  if  the  machine  is  driven  with  one  single  actuator  per  leg,  namely, 
the  one  coupled  to  the  triangular  platform,  then  we  should  eliminate  6j4  from  the  above 
expression,  which  is  readily  done  if  we  rewrite  the  reduced  relation,  eq.(50),  in  the  form 


ej4  X  (rj.4  -  rji)6j4  +  ^js  x  {tjs  -  rji  )djs  =  TjiXu>  +  c 


(52) 


Thus,  in  order  to  obtain  an  expression  containing  only  6js,  all  we  need  is  multiply  both 
sides  of  any  of  the  two  above  equations  by  a  suitable  annihilator.  For  example,  if  we  choose 
to  eliminate  6j4  from  the  first  of  those  equations,  we  can  do  this  by  dot-multiplying  the 
two  sides  of  the  first  equation  by  ej.*,  thereby  deriving 


X  ejs  •  (rjs  -  Tji)9js  =  x  pji  •  a>  +  ej<  •  c 
which  can  be  rewritten  alternatively  as 

cjBjs  =  k^t 

where  the  scalar  cj  and  the  6-dimensional  vector  kj  are  defined  below 

ej  =  tj4  X  ejs  •  (rjs  -  rji) 


f(ej4Xpji)’ 

'  1  .J. 


(53) 

(54) 

(55) 

(56) 


Under  these  conditions,  the  vector  of  actuated  joint  rates,  namely,  Og,  is  related  to  the 
twist  of  the  platform  as  indicated  below: 

J«a  =  Kt  (57a) 

where  J  and  K  are  3  x  3  matrices  defined  as 

J  =  diag(c/,  cu,  cm)  (57b) 


K  = 


Lki; 


(57c) 


J  and  K  thus  being  the  two  global  Jacobian  matrices  of  the  machine.  Notice  that  the  above 
relation  allows  the  determination  of  the  actuator  joint  rates  for  a  given  twist  of  the  platform. 
Alternatively,  if  the  above  mechanical  system  is  a  multi-fingered  hand,  the  same  relations 
allow  the  determination  of  the  actuator  joint  rates  for  a  given  twist  of  the  manipulated 
object. 


19 


8  Conclusions 


We  have  introduced  the  concepts  of  twist  generator  and  twist  annihilator,  their  duals  be¬ 
ing  the  wrench  generator  and  the  wrench  annihilator.  For  every  lower  kinematic  pair  we 
can  define  a  6  x  /  matrix,  where  /  is  the  degree  of  freedom  of  the  kinematic  pair,  that 
produces  a  relative  twist  of  the  two  coupled  links  when  the  /  joint  ratiw  of  the  pair  are 
specified.  Likewise,  the  same  kinematic  pair  transmits  a  relative  constraint  wrench  between 
the  coupled  links,  that  does  not  develop  any  power  onto  the  whole  kinematic  chain,  its  only 
role  being  to  keep  the  two  links  together.  Moreover,  we  have  shown  that  the  twist  anni¬ 
hilator  of  a  lower  kinematic  pair  is  an  orthogonal  complement  of  the  corresponding  twist 
generator.  Likewise,  the  wrench  generator  of  a  lower  kinematic  pair  is  the  transpose  of  the 
corresponding  twist  annihilator,  or  a  multiple  thereof.  We  believe  that  these  concepts  can 
find  extensive  applications  in  the  mechanics  of  grasping  and  in  better  understanding  the 
problem  of  hybrid  control,  i.e.,  force  and  motion  control  of  manipulators. 
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ABSTRACT.  A  systematic  process  for  constructing  the  equations  of  motion  for  multibody 
systems  containing  open  or  closed  kinematic  loops  is  presented  in  this  paper.  We  first 
illustrate  a  nonconvendonal  method  for  describing  the  configuration  of  a  body  in  space 
using  a  set  of  depen(tent  point  coordinates,  instead  of  the  more  classical  set  of  translational 
and  rotational  coordinates.  Based  on  this  point-coordinate  description,  body  mass  and 
applied  loads  ate  also  distributed  to  the  points.  For  multibody  systems,  the  equations  of 
motion  are  constructed  as  a  large  .set  of  mixed  differential-algebraic  equations.  For  open- 
loop  systems,  based  on  a  velocity  transformation  process,  the  equations  of  motion  are 
converted  to  a  minimal  set  of  equations  in  terms  of  the  system  joint  accelerations.  For 
multibody  systems  with  closed  kinematic  loops,  the  equations  of  motion  are  first  written  as 
a  small  set  of  differential-algebraic  eq'tations.  Then,  following  a  second  velocity 
transformation  process,  these  equations  are  converted  to  a  minimal  set  of  differential 
equations.  The  process  of  combining  the  point-coordinate  and  the  joint-coordinate 
techniques  provides  some  interesting  and  computationally  time  savisig  features. 


1.  Introduction 

The  derivation  of  equations  of  motion  for  computational  multibody  dynamics  has  been  the 
topic  of  many  research  activities.  The  scope  of  these  activities  has  been  quite  broad.  Some 
techniques  aUow  us  to  generate  the  equations  of  motion  in  terms  of  a  large  set  of  dependent 
coordinates  in  the  form  of  a  large  set  of  differential-algebraic  equations.  Other  techmques 
yield  the  equations  of  motion  as  a  minimal  set  of  ordinary  differential  equations.  Many 
other  "in  between"  approaches  provide  us  with  various  alternatives.  Each  technique  or 
formulation  has  its  own  advantages  and  disadvantages  depending  on  the  application  and 
our  needs. 

It  is  desirable  to  have  the  equations  of  motion  in  the  form  of  a  large  set  of  differential- 
algebraic  equations  due  to  their  simplicity  and  ease  of  manipulation.  ITie  configuration  of  a 
rigid  body  is  normally  described  by  a  set  of  translational  and  rotational  coordinates.  Then 
algebraic  constraints  are  introduced  to  represent  the  kinematic  joints  that  connect  the  bodies. 
The  Lagrange  multiolier  technique  is  employed  to  represent  the  joint  reaction  forces  in  the 
equations  of  motion.  Although  these  formulations  are  easy  to  consmtct,  one  of  their  main 
drawbacks  is  their  computational  inefficiency.  A  detailed  discussion  on  this  type  of 
formulation,  which  is  referred  to  as  the  absolute  coordinate  formulation,  can  be  found  in 
[1]. 
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A  method  which  has  the  simplicity  of  the  absolute  coordinate  formulation  and  it  also 
provides  computational  efficiency  is  the  so-called  joint  coordinate  formdation  [2).  In  this 
method  a  set  of  relative  joint  coordinates  is  defined,  and  the  equations  of  motion  are 
converted  from  absolute  coordinates  to  joint  coordinates.  For  open-loop  systems  this 
process  is  done  in  one  step,  and  the  resultant  equations  are  equal  in  number  to  the  number 
of  degrees  of  freedom  of  the  system.  The  conversion  process  can  be  performed  in  two 
steps  for  systems  containing  closed  loops.  It  has  been  demonsu'ated  that  the  joint 
coordinate  formulation  is  by  far  more  efficient  for  computational  purposes  than  the  absolute 
coordinate  formulation. 

One  elegant  method  for  generating  the  equations  of  motion  for  multibody  systems  has 
been  presented  in  several  papers  by  Garcia  de  Jalon  [3, 4],  This  method  takes  advantage 
of  a  rudimentary  idea  that  describes  a  body  as  a  collection  of  points  and  vectors.  The  idea 
may  initially  appear  as  a  step  backward  in  the  evolutionary  process  of  generating  the 
equations  of  motion.  However,  the  method  eventually  exhibits  many  interesting  and 
extremely  useful  features.  The  coordinates  and  components  of  points  and  vectors  that  are 
defined  to  describe  a  body  are  dependent  on  each  other  through  kinematic  constraints.  For 
example,  we  may  define  twelve  coordinates  and  six  constraints  to  describe  a  free  body  in 
space.  Furthermore,  aaditional  constraints  are  introduced  to  represent  the  kinematic  joints 
interconnecting  the  rigid  bodies.  This  process  yields  a  large  set  of  loosely  coupled 
differential-algebraic  equations  of  motioa  However,  these  equations  can  be  converted  to  a 
minimal  or  small  set,  as  in  the  joint  coordinate  formulation. 

In  this  paper  we  first  present  De  Jallon's  ideas  and  formulations  with  a  different  slant. 
Here,  the  bodies  are  described  only  by  points.  The  mass  and  the  external  force  associated 
with  each  point  are  determined  as  a  fiinction  of  the  inertial  characteristics  of  the  body  anci 
the  applied  force  acting  on  the  body.  The  equations  of  motion  are  derived  using  the 
equations  of  motion  for  a  system  of  particles  and  the  Lag^ge  multiplier  technique.  Then 
we  present  a  technique  based  upon  a  velocity  transformation  between  the  point  velocities 
and  a  set  of  joint  velocities,  in  order  to  transform  the  equations  of  motion  to  a  smaller  set. 
The  resulting  equations  of  motion  in  terms  of  the  joint  accelerations  can  be  expressed  in 
different  forms  for  systems  containing  open  and  closed  kinematic  loops.  These  equations 
have  all  the  useful  features  of  the  originad  absolute-joint  coordinate  formulations. 
Furthermore,  additional  improvement  in  computational  efficiency  is  made  mainly  due  to  the 
absence  of  rotational  coordinates. 

The  presentation  in  this  paper  is  organized  in  three  main  parts.  We  first  state  the 
equations  of  motion  for  a  ligid  body  using  the  traditional  translational  and  rotational 
coordinates,  or  body  coordinates.  Then,  we  describe  the  point  coordinate  method, 
followed  by  the  yomr  coordinate  method.  The  joint  coordinate  part  is  divided  into  open- 
loop  and  the  closed-loop  sections.  Finally  a  brief  conclusion  section  is  presented. 


2.  Notation 

One-dimensional  vectors  are  denoted  by  lower-case  bold-face  characters  (q,  f ,  to). 
Matrices  are  denoted  by  upper-case  bold-face  characters  (C,  D). 

Scalars  are  denoted  by  light-face  characters. 

A  right-subscript  denotes  a  body  or  a  joint  index. 

A  right-superscript  denotes  a  point  or  a  point  index. 

A  left-superscript  denotes  the  index  of  a  reference  coordinate  system;  if  the  reference 
system  is  a  nomr.oving  system,  then  the  left-superscript  is  omitted. 


An  over-score  "tilde"  indicates  the  conversion  of  a  3- vector  to  a  3  x  3  skew-symmetric 
&,  r  0  -a^  a, 

matrix,  i.e.,  if  a  =  aj  ,  then  a  =  a^  0  -a,  . 

a,  -a,  a,  0 


3.  Body  Coordinates 

Traditionally,  for  specifying  the  position  of  a  rigid  body  in  a  global  nonmoving  xyz 
coordinate  system,  it  has  b^n  sufficient  to  specify  the  spatial  location  of  the  origin  and  the 

angular  orientation  of  a  body-fixed  coordinate  system,  as  shown  in  Fig.  1.  For  a 
typical  body  f,  vector  c;  denotes  a  vector  of  coordinates  that  contains  a  vector  of  Cartesian 

transladonal  coordinates  r,.  =  [x.  y,  z,f ,  and  a  set  of  rotational  coordinates  such  as 
Euler  angles,  Euler  parameters,  etc.  A  3  x  3  rotational  transformation  matrix  A,  denotes 

the  angular  orientation  of  the  ^t|Ci  relative  to  the  xyz  system,  which  can  be  expressed  in 
terms  of  the  defined  rotational  coordinates.  With  tlus  transformation  matrix  the 
components  of  a  vector  described  in  the  body-fixed  coordinate  system  can  be  transformed 
to  the  xyz  coordinate  system  as  Sj  =  A;  %.  A  vector  of  velocities  for  body  i  is  defined  as 
Vf,  which  contains  a  vector  of  translational  velocities  f;  and  a  vector  of  angular  velocities 
Cl),-.  A  vector  of  acceleration  for  this  body  is  denoted  as  v,,  which  contains  r,  and  o),. 

of  mass  itN. 


Figure  1.  Locating  a  body  in  a  nonmoving  coordinate  system. 
The  Newton-Euler  equations  of  motion  for  body  i  are  written  as 


■m,i  oip/1  r  f/  I 


M  ,Vi  =  gi 

where  ra/  is  the  mass  of  the  body,  J;  is  the  inertia  tensor,  and  f,-  and  n,-  are  the  sum  of 
forces  and  moments  acting  on  the  body.  The  rotational  equations  of  motion  can  be 

expressed  in  terms  of  either  the  xyz  or  the  components  of  the  vectors.  If  the  inertia 

tensor  with  respect  to  the  coordinate  system  is  expressed  as  the  constant  matrix  'J,, 
then  J,  =  A,.'J.  AT. 


i- '  • 


4.  Point  Coordinates 


The  position  and  orientation  of  a  rigid  body  in  a  nonmoving  xyz  coordinate  system  can  be 
described  by  the  position  of  several  points  on  the  body.  It  will  be  shown  that  the  most 
general  case  requires  four  points.  These  points  will  be  referred  to  as  the  primary  points. 
Other  points  on  the  body  will  be  called  the  secondary  or  nonprimary  points,  where  their 
coordinates  can  be  described  in  terms  of  the  cooriinates  of  the  primary  points. 

4. 1 .  REPRESENTING  A  BODY  BY  PRIMARY  POINTS 

A  rigid  body  may  be  represented  by  two,  three,  or  four  primary  points,  as  shown  in  Figure 
2.  In  such  cases  we  need  six,  nine,  or  twelve  Carte.sian  coordinates,  respectively,  to  define 
the  position  of  these  points.  We  also  need,  respectively,  one,  three,  or  si*  constraints  of 
the  type 


(r'-r'f  (r'-rO-f'-^^=0  (2) 

Such  a  constraint  keeps  the  distance  between  i  and  j  points  on  the  same  rigid  body  a 
constant  We  will  refer  to  these  constraints  as  primary  constraints  in  order  to  distinguish 
them  from  the  kinematic  constraints  associmed  with  the  kinematic  joints.  The  Cartesian 
coordinates  of  these  primary  points  are  referred  to  as  the  basic  coordinates  of  the  body. 
One  major  advantage  of  using  basic  coordinates,  instead  of  three  translational  and  three  (or 
four)  rotational  coordinates  for  a  body,  is  the  elimination  of  the  rotational  coordinates  and 
the  corresponding  rotational  transformation  matrix. 


Figure  2.  Locating  a  body  by  its  primary  points. 

4.2.  LCXTATING  A  NONPRIMARY  POINT 

In  order  to  describe  the  coordinates  of  a  nonprimary  point  on  a  body  in  terras  of  the  body 
basic  coordinates,  we  need  to  examine  the  two-,  three-,  and  four-point  cases  separately. 

4.2.1.  Two  Points:  Point  A  on  the  axis  of  the  two  primary  points  has  distances  a^  anda^ 

from  the  two  primary  points.  A  positive  direction  from  point  1  to  point  2  is  defined  as 
shown  in  Figure  3(a).  The  coordinates  of  A  can  be  expressed  as  r'^  =  {a’  r^-a^r')!  . 

4.2.2.  Three  Points.  We  need  to  locate  point  A  as  a  function  of  the  coordinates  of  three 
primary  points,  as  shown  in  Figure  3(b).  Assume  that,  at  a  given  time  (e.g.,  the  initial 

time),  r',  r^,  r^,  and  r'' are  known.  (The  following  argument  is  also  valid  if  the 
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coordinates  of  these  points  are  known  in  a  local  coordinate  system  attached  to  the 
body.)  The  components  of  vectors  s^'',  s■’•^  and  s'*  arc  computed  as  s"'  =  r’-  r', 
s^''  =  r^~r',  and  s''  =  r''-  r'.  A  vectors  is  defined  perpendicular  to  s"'  and  s^''  as 

s  =  s^•'s'*•^  Now  vector  s  '  can  be  described  in  terms  of  the  components  of  s^'^  s■*’^  and 
s  as 

s''  =a's^-4a’s^-'+a^s 
or 

s''=Sa 

where  Ss[s^’'  s^''  s]  and  as  [o'  Then  the  coefficient  vector  a  is 

computed  (only  once)  as  a  =  S‘'s'' .  Then  at  any  given  time,  since  the  coefficients  are 
known,  we  can  determine  r''  for  known  ,  and  r^as 

r'  =r4aV-r')+a^(H-r')+a^(f^-r')(H-r') 

4.2,3.  Four  Points.  This  is  similar  to  the  three-point  case,  i.e.,  to  locate  a  point  A,  only 
three  of  the  four  points  may  be  used.  However,  the  fourth  point  can  be  used  to  obtain  a 

third  vector,  s^’',  replacing  vector  sin  the  previous  case.  Note  that  the  four  primary 
points  cannot  be  in  the  same  plane. 


Fipre  3.  Locating  a  nonprimary  point  A  in  terras  of  the  basic  coordinates. 

4.3.  KINEMATIC  JOINTS 

Kinematic  joints  between  rigid  bodies  can  be  described  in  the  form  of  algebraic  constraint 
equations  between  the  basic  coordinates.  For  example  if  the  primary  point  k  on  body  i 
coincides  with  the  primary  point  /  on  body  j  (e.g.,  a  spherical  joint),  then  we  can  write  a 
vector  constraint  as 

r*-r;=0  (3) 

However,  the  idea  behind  the  use  of  basic  coordinates  is  to  eliminate  the  need  for  defining 
some,  if  not  all,  of  these  simple  constraints.  This  is  achieved  by  allowing  bodies  to  share 
primary  points  and,  hence,  not  defining  any  unnecessary  basic  coordinates. 


4.3.1.  Spherical  Joint  If  two  bodies  are  connected  by  a  spherical  joint,  then  one 

point  is  shared  by  the  two  bodies  at  the  center  of  the  joint,  as  shown  in  Figure  4(a).  In  this 
case  the  two  bodies  ate  described  by  seven  primary  points,  twelve  primary  constraints,  and 
no  constraint  for  the  spherical  joint 

4.3.2.  Revolute  Joint  Two  primary  points  on  the  joint  axis  can  be  shared  by  the  two 
bodies,  as  shown  in  Figure  4(b).  In  this  case  we  need  six  primary  points  and  eleven 
primary  constraints. 


Spherical  joint 


Figure  4.  Shared  primary  points  for  bodies  connected  by  spherical  or  revolute  joints. 


Figure  5.  Primary  points  and  vectors  for  describing  kinematic  constraints 
representing  universal  and  preimatic  joints. 


4.3.3.  Universal  Joint  Assume  that  vectors  s,- and  sy  are  defined  on  joint  axes 
perpendicular  to  each  other,  as  shown  in  Figure  5(a).  These  vretors  are  also  defined 
between  the  primary  points  on  their  respective  bodies.  One  primary  point  is  shared  by  the 
bodies  at  the  intersect  of  the  universal  joint  axes.  Therefore,  we  need  seven  primary 
points,  twelve  primary  constraints,  and  one  additional  constraint  to  keep  vectors  Sj  and  sy 
perpendicular,  i.e., 

s/s,=0  (4) 

4.3.4.  Prismatic  Joint  For  a  prismatic  joint,  as  shown  in  Figure  5(b),  we  n^d  to  keep 
three  vectors,  s/,  sy ,  and  d,  pa^el.  These  three  vectors  are  defined  on  the  joint  axis. 

We  also  need  to  eliminate  the  relative  rotation  between  the  two  bodies.  This  can  be 
accomplished  by  defining  two  other  vectors,  such  as  n/  and  ny,  perpendicular  to  each  other 
and  also  perpendicular  to  the  joint  axis.  Therefore,  we  will  have  five  constraint  equauons. 


Sj  Sj  =  0  (5.a) 

i,.d  =  0  (5.b) 
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A  vector  product,  such  as  in  equation  5.a  or  5.b,  yields  only  two  independent  algebraic 
equations,  therefore  we  must  select  two  of  the  three  equations  as  our  constraints.  Normally 
due  to  the  rotation  of  the  bodies  during  an  analysis,  the  choice  of  the  two  equations  may 
change.  In  order  to  circumvent  this  issue  completely,  we  recommend  using  the  scalar 
product  constraint  twice,  instead  of  a  vector  product.  For  example,  if  vectors  n,-  and  m;  are 
defined  perpendicular  to  vector  s/,  then,  instead  of  equations  5.a  and  5.b,  we  may  use 

n7s^.  =0,  mi‘^s^=0 

n7d  =  0,  ni/d  =  0  (6) 

We  can  follow  a  similar  procedure  to  describe  the  necessary  constraints  for  other  types 
of  kinematic  joints  between  bodies  that  are  defined  by  basic  coordinates. 

4.4.  KINEMATICS  OF  A  MULTIBODY  SYSTEM 

For  a  mulubody  system  with  b  rigid  bodies  interconnected  by  kinematic  joints,  assume  that 
we  have  defined  p  primary  points.  Therefore,  we  need  three  3xp  vectors  of  basic 
coordinates,  velocities,  and  accelerations. 


The  basic  coordinates  are  dependent  upon  the  primary  constraints  and  the  kinematic  joint 
constraints.  Assume  that  there  are  m  independent  constraints, 

<I>(r)  =  0  ’  (7) 

Note  that  most,  if  not  all,  of  these  constraints  are  either  linear  or  quadratic  due  to  the  use  of 
the  basic  coordinate  method.  The  first  and  second  time  derivatives  of  these  constraints 
yield  the  velocity  and  acceleration  constraints, 

6  =  Df  =  0  (8) 

<i>sDr+Dr  =  0  (9) 

where  D  s  d),  s  9<I)/3r  is  the  Jacobian  matrix.  Since  the  consttaints  are  either  linear  or 
quadratic,  the  Jacobian  has  a  very  simple  form. 

4.5.  MASS  DISTRIBUTION 

Normally  a  rigid  body's  inertial  characteristics  are  described  by  its  mass  and  its  inertia 
tensor.  Since  we  are  defining  a  rigid  body  using  several  primary  points,  we  need  to  assign 
masses  to  these  and  possibly  to  other  points,  while  preserving  the  inertial  characteristics  of 
the  rigid  body.  We  demonsuate  a  mass  distribudon  technique  for  the  four-point  case  first, 
then  we  specialize  that  to  the  three-  and  two-point  cases. 


4.5.1.  Four  Primary  Points.  The  mass  distributions  of  points  must  satisfy  the  total  mass 
condition,  the  first  moment  condition,  and  the  second  moment  condition.  These  conditions 
provide  ten  algebraic  equations;  therefore,  we  can  have  up  to  ten  unknowns  to  solve  for. 
Four  of  the  unknowns  are  the  masses  of  the  four  primary  points,  and  the  other  six 
unknowns  can  be  six  coordinates  associated  with  the  position  of  the  four  primary  points. 
For  example,  two  of  die  primary  points  can  have  known  positions,  but  the  other  two  can  be 
placed  in  such  positions  that  our  ten  equations  are  satisfied.  Although  this  process  is  quite 
practical,  it  may  not  be  desirable  due  to  several  reasons:  If  the  positions  of  some  of  the 
primary  points  are  considered  as  the  unknowns,  then  the  resulting  algebraic  equations 
become  nonlinear,  which  may  not  be  an  attractive  feature.  We  also  want  to  have  the 
freedom  of  positioning  the  primary  points  on  the  bodies  in  accordance  with  the  joints  that 
connect  the  bodies,  in  order  to  reduce  the  number  of  basic  coordinates.  For  these  reasons, 
an  alternative  technique  is  proposed. 

In  addition  to  the  four  prim^  points,  we  introduce  six  secondary  points  with  unknown 
masses.  This  makes  the  total  number  of  unknown  masses  equal  to  the  number  of 
equations,  i.e.,  ten.  The  ten  equations  are  linear  in  terms  of  the  unknown  masses. 
However,  this  requires  the  position  of  the  secondary  points  to  be  described  in  terms  of  the 
position  of  the  primary  points,  i.e.,  in  terms  of  the  basic  coordinates.  There  are  infinite 
possibilities  for  positioning  the  six  secondary  points.  One  such  possibility,  which  is  also 
quite  simple,  is  shown  in  Figure-  6(a).  Each  secondary  point  is  located  between  two 

primary  points.  We  number  the  primary  points  I, ..,  4  and  the  secondary  points  5 . 10. 

Hence,  the  position  of  tiie  secondly  points  can  be  described  as 


sf=(s.'+s?)/2 


(10) 


Note  that  a  vector  s/  locates  a  point  with  respect  to  the  body's  mass  center. 


Figure  6.  Primary  and  secondary  points  for  mass  disuibution. 
The  ten  equations  are  written  as 
to 

£m'=m,. 

JO 

m'  =0 

J‘J 
10 

‘s'  m'=% 
j’t 


(11) 

(12) 

(13) 
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The  first  expression  yields  one  equation,  the  second  expression  yields  three  equations,  and 
the  third  expression  yields  six  equations.  These  equations  can  be  solved  for  the  ten 
unknown  masses. 

4.5.2.  Three  Primary  Points.  This  is  a  special  case  of  the  four-primary-point  formulation. 
In  order  to  satisfy  the  ten  equadcns.  the  three  primary  points  (1, 2, 3),  the  three  secondary 
points  ( 4, 5,  6),  and  the  center  of  mass  of  the  body  must  all  be  in  the  same  plane.  As 

shown  in  Figure  6(b),  we  may  assume  that  these  points  are  in  the  plane  with  its  origin  at 
the  mass  center,  i.e.,  =0;  j  =  Equations  1 1-13  can  be  used  here  again,  but  for 

six  masses  instead  of  ten.  Some  of  these  ten  equations  are  automatically  satisfied:  the  third 
equation  in  equation  12  and  two  equations  associated  with  the  ^  products  of  inertia  in  the 

equation  13.  One  necessary  condition  is  that  the  moment  of  inertia  about  the  ^  axis  should 
be  equal  to  the  sum  of  the  moments  of  inertia  about  the  other  two  axes,  i.e., 
jt;?)  _  j(«)  ^  jdin)  jjjIj  condition  automatically  satisfies  another  equation  in  equation  13. 
Then  we  are  left  with  six  equations  and  six  unlmown  masses; 


£m'  =  m, , 
1=1 


;«/ 


Xtli  =0, 


XTirm'=j‘«',  m'=j‘^' 

1=1  1=1  ;■>>/ 

4.5.3.  Two  Primary  Poinu.  Primary  points'!  and  2  form  a  line  that  passes  through  the 
mass  center  as  shown  in  Figure  6(c).  One  secondary  point  (point  3)  along  this  line  is 

defined.  Since  the  ^  and  q  coordinates  for  all  three  points  are  zero,  the  ten  equations  yield 
the  following  necessary  conditions:  all  three  products  of  inertia  must  be  zero 

( =  0 );  the  moment  of  inertia  about  the  ^  axis  must  be  zero  ( =  0);  and 

the  moments  of  inertia  about  the  other  two  axes  must  be  equal  ( =  j*’’’”).  Then  we  have 
three  equations  in  three  unknown  masses: 

m^  +  m^  +  m'*  =  m, 
m'C'  +  ra^;f+m^Cf  =  0 

One  likely  situation  is  that  the  two  primary  points  have  equal  distances  from  the  mass 
center  and  then  the  secondary  point  is  positioned  at  the  mass  center  itself.  If  the  length 
between  the  two  primary  points  is  denoted  as  t,  then  the  three  masses  are  found  to  be 
=  m^  =  2j*^’ /  and  m''  =  mi-4j‘^^’/^’.  Furthermore,  if  =  m.-^^  / 12,  then 
m^  =  m^  =  m, /6  and  ra^  =  2m,  /3. 

4.6.  FORCE  DISTRIBUTION 

A  force  or  a  moment  acting  on  a  rigid  body  must  be  resolved  into  one  or  more  forces  acting 
on  the  primary  points.  Tne  resultant  force  and  moment  associated  with  this  force 
distribution  must  be  equivalent  to  the  original  force  and/or  moment. 


1 


4.6.1.  Four  Primary  Points  ( Force).  Consider  a  single  force  acting  at  point  P  as  shown  in 
Figure  7(a).  Point  P  is  positioned  from  the  mass  center  by  vector  sf .  We  need  to  find  an 
equivalent  set  of  four  forces  acting  on  the  four  particles.  We  may  assume  that  the  four 
forces  are  all  parallel  to  the  original  force  ff ,  i.e.,  =  a'  ff ;  j  =  1,..., 4  ,  where  a'  are 

four  unknown  coefficients.  We  need  to  satisfy  the  following  conditions; 

Xf'=fr  (14) 

i‘i 

(15) 


Since  these  equations  must  be  valid  for  any  ff ,  we  get  four  equations  in  four  unknowns: 


’4' 
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Tlf 

a' 

Tlf 

c: 
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_i  1 

1 

1 . 

a"* 

_  1  _ 

Note  that  the  unknown  coefficients  are  a  function  of  the  position  of  point  P  and  not  a 
function  of  the  magnitude  or  the  direction  of  the  applied  force. 

4.6.2.  Three  Primary  Points  (Force).  Since  the  three  primary  points,  the  body  mass 
center,  and  the  point  of  application  of  the  force  must  all  be  in  the  same  plane,  as  shown  in 
Figure  7(b),  we  can  write  the  following  three  equations  in  three  unknown  coefficients: 


a' 

X' 

Tl? 

Tif 

= 

1 

1 

1 

a-' 

1 

Figure  7.  A  force  acting  on  a  body  represented  by  primary  points. 

4.6.3.  Two  Primary  Points  (Force).  As  shown  in  Figure  7(c),  the  two  primary  points 
and  point  P  form  a  straight  line.  The  equations  for  the  three-point  case  are  further 
simplified  to: 
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r?;  Cl 

a' 

[i  iJ 

.a^ 

_  1  _ 

4.6.4.  Four  Primary  Points  ( Moment).  Assume  a  pure  moment  acting  on  the  body. 

There  is  m  than  one  way  to  find  a  set  of  forces  acting  on  the  primary  points  equivalent  to 
the  applied  moment.  One  solution  is  to  assume  six  forces  with  unknown  magnimdes  acting 
on  some  of  the  points  with  known  direcrions.  The  directions  can  be  defined  to  be  between 
the  points,  as  shown  in  Figure  8.  The  six  forces  must  satisfy  the  following  equations: 

if'=0  (16) 

isfr=n,  (17) 

1^1 


If  we  describe  unit  vectors  u  "'  along  the  axes,  we  can  solve  the  following  six  equations  for 
six  unknown  magnitudes: 


ui.: 

1 - 

9 

O' 

n 

We  note  that  the  solution  to  these  equations  is  a  fimction  of  the  magnitude  and  the  direction 
of  the  applied  moment  n. 


Figure  8.  Representing  a  moment  by  six  forces. 


Another  method  for  obtaining  a  solution  independent  of  the  applied  moment  is  to 
consider  four  forces  acting  on  the  four  primary  points  as 


Substituting  these  forces  in  equations  16  and  17  (noting  that  the  equations  must  be  valid  for 
any  n)  yields 
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Since  all  four  forces  are  in  a  plane  perpendicular  to  n.  then  only  four  of  these  six  algebraic 
equations  are  independent,  and  they  can  be  solved  for  the  four  unknown  coefficients. 

4.7.  EQUATIONS  OF  MOTION  AND  INERTLY.  MATRIX  j 

In  order  to  derive  the  equations  of  motion  for  a  rigid  body  using  the  basic  coordinate  , 

representation,  we  need  the  equations  of  motion  for  a  system  of  particles  and  the  Lagrange  i 

multiplier  technique.  We  first  show  the  process  for  a  two-primary-point  case,  then  we 
repeat  the  process  for  three-  and  four-point  cases.  In  each  case  we  assume  that  the  masses 
of  the  primary  and  secondary  points  are  already  determined. 

i 

4.7.1.  Iwo  Primary  Points.  Assume  that  two  forces,  and  f^.  act  on  two  primary 
points,  as  shown  in  Figure  9.  Between  the  two  primary  and  one  secondary  points,  the 
following  constraints  exist: 

(r'-r^)^  =  (18.a) 

r'+r^-2r^=0  (18.b) 


1 
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Figure  9.  Two  forces  acting  on  a  body  represented  by 
two  primary  and  one  secondary  points. 

The  ume  derivadve  of  these  constraints  yields  the  velocity  constraints: 


(r'-r^f  (f'-r-)  =  0  (19.a) 

r'+r-2r^=0  (19.b) 

Similarly,  the  accelerauon  constraints  are 

(r'-r-)^  (r'-r’)  =  -(f'-r'f  (r'-r')  (20.a) 

r'+r-2r^=0  (20.b) 

Using  the  Lagrange  multiplier  technique,  the  equations  of  motion  for  these  three 
constraTned  particles  are  written  as 

m'r'-(r'-r-)^'-k^=f'  (2  La) 

m‘r‘+(r'-r)X' -V  =  f‘  (21.b) 
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m‘r'  +  2A.‘  =  0 


(21.0 


where  }J  contains  one  multiplier  associated  with  the  tlrst  constraint  equation  and  X' 
contains  three  multipliers  associated  with  the  second  set  of  constraints. 

(n  order  to  eliminate  the  Lagrange  multipliers  A.'  and  the  acceleration  vector 
associated  with  the  secondary  point,  we  add  equations  21.a  and  21.c.  add  equations  21. b 
and  21.C.  then  we  use  equation  20.b.  This  yields  the  equations  of  motion  for  a  rigid  body 
in  terms  of  the  primary  point  accelerations. 


,  /  m  .  - 

(ra'  +  — )I 
4 

iHil 
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(ra^  + 


(22) 


The  complete  set  of  equations  of  motion  contains  equations  18.a.  19.a.  20.a.  and  22.  .Vote 
that  the  mass  matrix  is  a  6  x  6  matrix. 

For  the  special  case  with  m' =  m‘ and  m'’  =  m,  -  4j'^’*  /  f and  the 
special  case  with  m'  =  m^  =  m,  /  6  and  m-'  =  2m,  /  3.  the  mass  matrices  become, 
respectively. 
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4.7.2.  Three  Primary  Points.  We  repeat  a  process  similar  to  the  two-point  case  by  writing 
the  necessary  constraint  equations  and  the  equations  of  motion  for  three  primary  and  three 
secondary  points  (particles).  Then  the  Lagrange  multipliers  and  the  acceleration  vectors 
associated  with  the  secondary  points  ate  eliminated  to  obtain 
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where 


/  m^  +  m^  2  m''  +  ra^  ,  m^  +  m^ 

m„  =  m‘+ — ,  /n;j=  m  + - - — ,  =  m  + 

m^  m*  m^ 


In  addition  to  these  equations,  we  must  consider  three  primary  constnunts  and  their  first 
and  second  time  derivatives. 


4.7.3.  Four  Primary  Points.  For  this  case  the  equations  of  motion  are  found  to  be 
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(24) 


In  addition  to  these  equations,  we  must  consider  six  primary  constraints  and  th«ir  first  and 
second  derivatives.  Note  that  the  sum  of  all  16  components  of  the  mass  matrix  is  equal  to 
the  mass  of  the  body. 


4.8.  DYNAMICS  OF  A  MULTIBODY  SYSTEM 


The  basic  coordinate  representation  of  rigid  bodies  allows  us  to  determine  the  equations  of 
motion  of  a  system  of  multibodies  interconnected  by  kinematic  joints  quite  easily.  Here 
we  demonstrate  the  process  by  using  a  simple  example.  Assume  that  two  bodies  are 
connected  by  a  spherical  Joint,  as  shown  in  Figure  10.  The  system  is  represented  by  seven 
primary  points.  Since  the  primary  point  number  4  is  shared  by  the  two  bodies,  its  mass 
receives  contribution  from  both  bodies.  Similarly,  the  applied  force  on  this  point  receives 
contribution  from  the  forces  that  act  on  both  bodies.  The  mass  matrix  and  the  force  vector 
are  written  as: 


'm,i  I  m,2 1  m,j  I  I 
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fflj;  I  mjj  I  /Hy  J  /rZy  I 
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where  , 


f,=f  +f,. 


Figure  10.  Two  bodies  connected  by  a  spherical  joint. 

This  example  shows  how  the  mass  and  the  force  of  shared  primary  points  are 
constructed.  In  general,  the  equations  of  motion  fora  multibody  system  are  written  as 


d>(r)  =  0 

(7) 

<t)  s  Dr  =  0 

(8) 

*  s  Dr+  Df  =  0 

(9) 

Mf-D^X  =  f 

(25) 

where  ‘I>(r)  =  0  contains  all  the  primary  and  joint  constraints,  and  the  vector  of  Lagrange 
"’ultipliers  X  contains  the  muldpliers  associated  with  all  of  the  constraints. 


5.  Joint  Coordinate  Formulation  for  Open  Loop  Systems 

The  constrained  equations  of  motion  expressed  by  equations  7-9  and  25  can  be  converted 
to  a  smaller  set  of  equations  in  term.'  of  a  set  of  cooidinates  known  as  the  joint  coordinates. 
For  multibody  systems  with  open  kinematic  loops,  this  conversion  yields  a  set  of  ordinary 
differential  equations  equal  to  the  number  of  degrees  of  freedom  of  the  system. 

In  a  multibody  system  with  open  kinematic  loops,  we  define  the  necessary  joint 
coordinates  for  each  kinematic  joint  in  the  system.  For  example,  revolute  and  prismatic 
joints  require  one  joint  coordinate  each,  universal  and  cylindrical  joints  require  two  joint 
coordinates  each,  and  for  a  spherical  joint  we  need  three  joint  coordinates.  The  time 
derivative  of  most  joint  coordinates  is  referred  to  as  the  Joint  velocity.  For  a  spherical  joint, 
the  relative  angular  velocity  vector  is  the  joint  velocity  between  the  two  bodies.  If  the 
system  is  not  connected  to  the  ground  by  any  Idnematic  joints,  then  one  of  the  bodies  is 
selected  as  a  floating  base  (or  root)  body.  The  absolute  translational  and  angular  velocities 
of  the  base  body  are  considered  as  the  joint  velocity  of  the  base.  If  the  system  is  connected 
to  the  ground  by  a  kinematic  joint,  then  the  ground  is  selected  as  a  flxed  base.  For  the 
floating-base  and  the  fixed-base  systems  shown  in  Figure  1 1  we  define  the  joint  velocity 
vectors  as 


numbered  in  any  desired  order.  However,  here  for  convenience,  a  joint  carries  the  number 
of  the  connecting  body  in  the  direction  of  the  leaf.  In  order  to  clarify  the  notation  and  some 
of  the  definitions,  assume  that  two  bodies  in  a  branch  are  connected  by  a  joint  as  shown  in 
Figure  12.  Joint/  is  called  the  incoming  joint  for  body /and  the  exit  joint  for  body /-. 
Therefore,  it  is  said  that  joint  /  belongs  to  body  /.  not  body  /-.  In  an  open-loop  system, 
each  body  has  only  one  incoming  joint,  but  it  may  have  none.  one.  or  more  exit  joints. 
Each  body  has  a  reference  point,  which  is  a  point  defined  by  its  joint.  For  example,  the 
center  of  a  spherical  joint  or  any  point  on  the  a.xis  of  a  revolute  joint  is  the  reference  point 
for  its  body.  Again  for  convenience,  the  primary  point  selected  as  the  reference  point  for  a 
body  carries  the  same  index  (number)  as  the  body  (and  its  joint),  with  the  possible 
e.xception  of  a  floating-base  body. 


Primary  Point  / 


(root)  • 


•  (leaf) 


Joint  / 


Figure  12.  The  joint,  the  reference  point,  and  the  primary  point  belonging  to  body  /. 

For  multibody  systems  where  the  bodies  are  described  by  primary  points,  it  can  be 
shown  that  Jiere  exists  a  simple  transformation  between  the  joint  velocity  vector  and  the 
vector  of  point  velocities 

r  =  Bq  (26) 

Matrix  B  is  called  the  velocity  transformation  matrix,  and  it  is  a  function  of  the  basic 
coordinates.  We  can  show  that  this  matrix  is  orthogonal  to  the  Jacobian  matrix  D  by 
substituting  equation  26  into  equation  8  to  obtain  DBq  =  0.  Since  q  is  a  vector  of 
independent  velocities,  then 


DB  =  0  (27) 

The  time  derivative  of  equation  26  gives  the  transformation  fonnula  for  the  accelerations: 

r  =  Bq-t-Bq  (28) 

Substituting  this  equation  into  equation  25.  premultiplying  both  sides  by  B^ .  and  then 
taking  advantage  of  equation  27  yield 


where 


.v/f  =  / 

(29) 

M  =  B'^MB 

(30) 

/  =  B'^(f-MBq) 

(31) 

Equauon  29  represents  the  generalized  equations  of  motion  for  an  open-loop  multibody 
system. 

5.1.  VELOCITY  TRANSFORMATION  MATRIX 


Systematic  construcuon  of  the  velocity  transformation  matrix  can  be  demonstrated  with  an 
example. 

Example  I:  Assume  that  in  the  open-loop  single-branch  system  shown  in  Figure  13(a) 
we  have  a  floating-base  body,  two  revolute,  one  translational,  and  one  spherical  joint.  As 
shown  in  Figure  13(b),  we  need  to  use  fifteen  primary  points  to  represent  the  five  bodies  in 

this  system.  Since  body  1  is  selected  as  the  base  body,  a  reference  frame  is  attached 
to  its  mass  center,  and  the  translational  and  angular  velocities  of  this  frame  relative  to  a 
nonmoving  reference  frame  are  considered  as  the  Joint  velocity  vector  of  the  base.  For 
convenience,  we  denote  the  mass  center  of  the  base  as  point  0.  We  have  numbered  the 
primary  points  such  that  points  0,  2,  3,  4  and  5  are  the  reference  points  for  bodies  I.  2,  3, 
4,  and  J.  respectively.  We  can  write  the  following  velocity  equations: 


(b) 

Figure  13.  An  open-loop  .system  and  its  representation  by  primary  points. 


We  noie  ihe  following  relaaonships: 
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CO,  =  co^  +  Uj9^ 
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We  now  substitute  equauons  (b)  into  equations  (a)  in  a  forward  process  from  the  base 
toward  the  leaf.  We  also  simplify  the  equations  by  using  relationships  such  as 

d‘-*+ d*''  =  d‘'' .  Then,  the  following  velocity  transformation  equation  is  obtained  in 
matrix  form: 
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In  this  equation  we  have  the  velocity  of  the  primary  points  on  the  left-hand  side  and  the 
joint  velocities  on  the  n^t-hand  side.  The  coefficient  matrix  of  the  joint  velocity  vector  is 
the  velocity  uansformation  matrix  B.  Instead  of  listing  the  velocities  of  the  prunary  points 
m  ascending  order,  we  have  grouped  them  by  bodies  in  order  to  demonstrate  the  tnangular 
form  of  this  matrix.  From  the  structure  of  this  matrix,  we  note  that  the  matrix  can  be 
partiuoned  into  submatrices  (block  matrices),  which  are  associated  with  different  types  of 
kinematic  joints.  Table  1  provides  the  block  matrices  for  several  kinematic  joints.  The  last 
column  in  tiiLS  table  provides  the  time  derivatives  of  these  block  mauices.  since  they  are 

needed  in  evaluating  B  for  the  equauons  of  motion.  Block  matrices  for  other  types  of 
joints  can  oe  constmcted  from  the  elementary  block  matnces.  as  shown  m  Table  2.  Note 

that  the  components  of  d'"'  and  d‘"'  vectors  can  be  computed  as 
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d'-'=r'-r 

d‘-^=r'-P 


Table  1.  Elementary  Block  Matrices 


B  = 


Table  2.  Composite  Block  Matrices 


Joint  type 

~Matrixsize  Ydentifier  - - 

Universal 

Cylindrical 

J  X  2  iji./  ^!1  - • 

u  [-d-u‘;>  -d-u‘=> 

3x2  Q'.J  r  . 

h-\  “,l 

p«,o 

f 

p;.o 

p/.a 

\ 

P«,a 

•  j 

1 

pi>.o 

R’^ 

pj.o 

Ra.2 

piJ 

p/a.o 

R/a.: 

pWJ 

p//.a 

R//.a 

p//.J 

pj.o 

rJ.2 

p4J 

s-'-' 

p/a.o 

R/:.: 

pi2J 

SI2.4 

p//,a 

r;/.; 

pn,2 

S".2 

'  A 

p/j.a 

pijj 

SU.4 

t 

p/<,a 

R/..a 

pl4,J 

gl4.4 

r;..5 

p/5.a 

R/a.; 

pJ3.3 

Sis.4 

R/a.a 

> 
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Example  2:  The  multibody  system  shown  in  Figure  i4fa)  has  a  fixed-base  and  three 
revolute,  and  one  spherical  joint.  The  primary  point  representation  of  the  system  is  shown 
in  Figure  14(b).  Since  the  incommg  joint  for  body  1  is  fixed  to  the  ground,  we  need  not 
consider  the  primary  point  1  in  the  vector  of  velocities  since  its  velocity  remains  zero. 

From  the  topology  of  the  system,  the  velocity  relations,  as  well  as  the  B  matrix,  are  written 
as 


r* 

OH 

Rj.l 

R"-'  S''--' 

r;./ 

■01  ■ 

rO.I 

6, 

r;.1  r7..’ 

rK,/  gS.J 

.01. 

f’ 

rJ.1 

•10 

^lOJ  glOJ  ^10,4 

r" 

g/U  ^IL4 

II 


Figure  14.  A  multi-loop  fixed-base  system  and  its  primary  point  representation. 

5.2.  rNTEGRATION  OF  THE  EQUATIONS  OF  MOTION 

The  equations  of  motion  for  open-loop  rauitibody  systems  represent  a  set  of  nonlinear 
ordinary  differential  equations  that  can  be  put  in  the  standard  form 

y  =  f(y.t)  (32) 

where  y  and  y  arrays  contain  joint  coordinates,  velocities,  and  accelerations  as; 


y  = 


y  = 


(33) 


I 

I 


i 

a 


I 


a 


The  numerical  soludon  of  the  equauons  of  mouon  requires  a  numerical  integradon 
process  that  predicts  the  elements  of  y  at  any  ume  step  t.  The  soludon  of  the  equadons  of 
mouon  must  determine  and  return  the  elements  of  y  to  the  integradon  algorithm.  The 
elements  of  y  can  be  obtained  from  the  elements  of  y  by  impleraenung  the  followmg  steps: 

1.  The  contents  of  y  are  known:  i.e..  q  and  q . 

2.  In  a  forward  process,  moving  from  the  base  towards  the  leaves,  compute  the 
basic  coordinates  r. 

3.  Evaluate  maUTX  B. 

4.  In  a  forward  process,  moving  from  the  base  towards  the  leaves,  or  by  using 
matrix  B.  compute  the  basic  velocides  r. 

5.  Evaluate  matrix  B. 

6.  Evaluate  the  basic  coordinate  mass  matrix  and  force  vector.  M  and  f  (refer  to 
equadon  25). 

7.  Evaluate  the  joint  coordinate  mass  mauix  and  force  vector.  M  and /  (refer  to 
equauons  30  and  31) 

8.  Solve  the  equadons  of  modon  for  q  (refer  to  equadon  29). 

9.  ConsUTict  y  array  and  remm  the  contents  to  the  integradon  algorithm. 


6.  Joint  Coordinate  Formulation  for  Closed-Loop  Systems 

For  muldbody  systems  with  closed  kinemadc  loops,  the  equadons  of  modon  in  terms  of 
joint  coordinates  can  be  determined  in  several  ways.  We  first  derive  these  equauons  as  a 
set  of  differential-algebraic  equadons.  then  we  reduce  them  to  a  minimal  set  of  differenuaJ 
equadons.  We  note  that  a  closed-loop  system'  may  contain  one  or  more  closed  loops.  A 
closed  loop  can  be  eliminated  from  a  system  by  removing  one  joint,  which  is  called  a  cut 
joint.  All  matrices  and  vectors  associated  with  a  cut  joint  carry  a  right  superscript  or 
subscript  ®.  By  cutting  as  many  joints  as  the  number  of  closed  loops,  an  open-loop 
system,  which  is  called  a  reduced  system,  is  obtained.  This  process,  in  most  cases,  yields 
addidonal  branches,  and  hence  new  leaves  are  formed.  The  cutting  process  of  a  closed 
loop  IS  shown  in  Figure  15. 


Figure  15.  A  closed-loop  system  and  its  reduced  open-loop  represenmuon. 

6. 1 .  DEFFERENTIAL-.UGEBRAIC  EQUATIONS  OF  MO'ITON 

For  the  reduced  system  we  define  a  vector  of  joint  coordinaie.i  q.  and  then  its 
corresponding  matrix  B.  We  note  that  for  uie  cut  joint(s),  we  do  not  define  any  joint 
coordinates.  Furthermore,  for  the  reduced  system  we  v/iite  the  equadons  of  motion  as 
descnbed  in  equadon  31.  Now  the  cut  joint  is  put  back  in  order  to  obtain  the  original 
closed  loop  system.  In  the  original  system  the  joint  coordinates  that  are  within  a  closed 


loop  are  no  longer  independent  The  dependency  of  these  joint  coordinates  can  be 
descnbed  by  co'nstramt  equations  between  the  primary  points  of  the  two  bodies  that  share 
the  cut  joint.  These  constraints  are  written  as 


d)«(r)  =  0  (34) 

where  r  contains  only  some  of  the  basic  cooitiinates  of  the  connecting  bodies.  The  time 
derivative  of  these  constraints  provides  the  velocity  constraints. 

<i>*  =  D*r  =  D*Bq  =  Cq=0  (35) 

where  D*  is  the  Jacobian  of  the  constraints  in  equation  34  and  C  =  D*B  is  the  coefficient 
matrix  of  the  joint  velocities  in  equation  35.  Some  of  the  constraints  in  equation  34. 
depending  on  the  nature  of  the  closed  loop,  may  be  redundant  Therefore,  some  of  the 
rows  of  C  may  also  be  redundant  and  must  be  eliminated.  The  tune  derivative  of  equation 
35  yields  the  acceleration  constraints. 

4)*sCq+Cq  =  0  (36) 

where  C  =  D*B+  D*B.  Due  to  these  constraints,  with  the  use  of  Lagrange  multipliers, 
equation  31  is  modified  as 

-Wr-C^v-t/  (37) 

where  V  contains  the  Lagrange  muldpliers.  Equations  34-37  form  a  set  of  differential- 
algebraic  equations  describing  the  dynamics  of  a  multibody  system  with  closed  loops. 

6.1.1.  Evaluation  of  C  Matrix.  The  elements  of  C  can  be  found  using  different 
techniques.  The  ^roduct  D*B  can  be  evaluated  numerically  since  the  elements  of  both 

matrices  can  be  computed  numerically.  However,  since  the  elements  of  D*  and  B  are 
available  in  closed  form,  the  elements  of  C  may  be  found  in  closed  form  also. 

The  elements  of  D*  can  be  expressed  in  closed  form  for  most  common  kinematic  joints 
that  may  end  up  as  cut  joints.  It  is  shown  in  section  4.3  that  we  can  construct  the  necessary 
constraint  equations  describing  various  kinematic  joints  by  combining  some  of  the 
following  consuaints  (refer  to  Figure  16): 

rf-r;=0  (3),  s,%=0  (4).  s/d  =  0  (6) 

where  s,=r,'"-r*,  s^=r^-r',  d  =  r'-r^ 


Figure  16.  A  cut  joint  (constraints)  between  two  bodies. 
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The  enines  of  the  Jacobian  matrix  D®  associated  with  these  constraints  are  shown  in  Table 
3.  The  columns  are  associated  with  the  primary  points  that  appear  in  the  constraints. 


Table  3.  Entries  of  the  Jacobian  matrix  D® 

Point  =>  k  ml  n 

Cut  joint  It _ 

bquauon  (3)  I 

Equation  (4)  f 

Equauon(6)  -(d+s,)'^ 


The  enuies  of  the  C  matrix  for  different  cut  joints  (cut  constraints)  can  be  found  in 
closed  form  by  inspecting  the  product  of  the  entries  of  Tables  1  and  3.  Tlie  results  of  such 
inspection  are  shown  in  table  4  for  different  joint  coordinates.  Figure  17  shows  the 
indices  and  vectors  used  in  this  table.  The  entries  of  the  table  are  stated  for  a  joint  in  the 
branch  associated  with  body  /.  For  a  joint  in  the  branch  associated  with  body  j,  the  .sign  of 
the  entry  must  be  reversed. 


Table  4.  Entries  of  the  C  matrix 


Roating 

Base 

Revolute 

Prismatic  Sphencal 

Equation  (3) 

U 

u. 

-d*' 

Equation  (4) 

0 

0  s/s, 

Equation  (6) 

0 

s,''d*-'u. 

-s/u. 

s/d®" 

Note  that  d®-' =  d*-' =  d'-' 


Figure  17.  The  indices  and  vectors  used  in  generating  matrix  C. 

Example  3:  Consider  the  closed-loop  system  shown  in  Figure  18  containing  two 
revolute,  one  spherical,  and  one  universal  joint.  The  system  is  not  attached  to  the  ground. 


thereibre  one  body  ( body  I )  is  considered  as  the  floaung  base.  If  the  universal  joint  is 
selected  to  be  the  cut  joint,  we  need  the  following  constraints  from  equations  3  and  4: 

r}-r]  =0 

s/sj  =  0 

Wedefmethe  vector  of  joint  velocities  as  q  =  [v/,  0„  BjT.  Then  Table  3  yields 

the  Jacobian  matrix  C, 


C  =  ro  -d'-V*  -d'"* 

0  s/ijU,  s/s^ 

The  elements  in  the  column(s)  associated  with  the  velocity  vector  of  body  I  are  zero  since 
body  /  is  a  floating-base  body.  The  actual  Jacobian  is  a  4  x  5  matrix,  i.e.,  the  closed  loop 
exhibits  one  degree  of  freedom. 


Figure  18.  A  closed-loop  system. 

6.1.2.  Multiple  Leaps.  A  rauliibody  system  with  more  than  one  closed  loop  yields  a  C 
matrix  containing  submatrices  that  are  either  uncoupled  or  loosely  coupled.  For  the  two 
uncoupled  loops  shown  in  Figure  19(a),  the  two  submatrices  of  C  are  also  uncoupled. 

^^[0  [C,]  0  0  o' 

^  [O  0  0  [Cj]  0 

Loop  1 


Loop  2 

(a)  (b) 

Figure  19.  Examples  of  uncoupled  and  coupled  closed-loop  systems. 
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In  this  case,  the  submatrices  can  be  treated  separately  during  the  analysis.  For  the  two 
coupled  loops  shown  in  Figure  19(b).  the  subraatrices  of  C  are  coupled. 


1 


C  = 


0  [  c,  ) 

[O  0  [  C; 


0  0 
I  0 


6.1.3.  Integration  of  the  Equations  of  Motion .  The  mixed  differential-algebraic  equations 
of  mouon  for  closed-loop  multibody  systems,  presented  in  ^uanons  34-37.  can  be  solved 
for  the  dynamic  response  of  the  system  by  using  a  process  similar  to  the  algorithm  of 
section  5.2.  The  y  and  y  arrays  are  defined  as  in  equations  32  and  33.  and  the  first  seven 
steps  of  the  algorithm  remain  unchanged; 


8.  Evaluate  matrix  C. 

9.  Solve  the  equations  of  motion  for  q  and  v  (refer  to  equations  32  and  33). 

10.  Construct  y  array  and  renim  the  contents  to  the  integration  algorithm. 

This  is  a  simple  algorithm  which  does  not  account  for  possible  constraint  violation  due  to 
numerical  errors. 

6.2.  DIFFERENTIAL  EQUATIONS  OF  MOTION 

The  differential-algebraic  ^nations  of  motion  for  a  closed  loop  system  can  be  converted  to 
a  set  of  ordinary-differential  equations  without  any  constraints.  For  this  purpose,  within 
each  closed  loop  we  select  a  set  of  independent  joint  velocities,  equal  to  the  number  of 
degrees  of  freedom  associated  with  the  loop,  to  form  a  vector  of  independent  joint 
velocities  q"’ .  A  closed-loop  velocity  transformation  matrix  E  can  be  defined  as 


q  =  Eq 


(0 


(38) 


One  characteristic  of  E  Ls  that  it  is  orthogonal  to  the  Jacobian  C.  This  can  be  shown  by 
substituting  equation  38  into  equation  36  to  obtain  CEq'’*  =  0.  Since  q'’’  contains 
independent  velocities,  then 

CE  =  0  (39) 

The  time  derivative  of  equation  38  yields  the  acceleration  transformation  formula  as: 

q=:Eq''4Eq''’  (40) 

Now  substituting  equation  40  into  equation  37,  premultiplying  both  sides  by  E’^.  then 
using  equation  39  yields 


Maf'^  =  f 


v/here 


M  =  E^  MZ 


(41) 


(42) 
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(43) 


/  =  E'(/-:V/Eq^‘') 

Equation  41  provides  a  set  of  nonlinear  ordinary-differential  equauons  of  mouon  equal  to 
the  number  of  degrees  of  fneedom  of  the  system. 

6.2.1.  Evaluation  of  Matrix  E.  Matrix  E  can  be  obtained  from  matrix  C  using  the 
constraints  of  equation  35.  By  partitioning  the  vector  of  joint  velocities  into  two  dependent 
and  independent  sets,  and  respectively  partitioning  C  into  two  submatrices,  equation  35  can 
be  written  as 

C(»^(o+CV'>q«»=o 
This  yields  q"”  =  or 


This  provides  a  closed  form  formula  for  matrix  E  as  a  function  of  the  submatrices  of  C. 


In  most  practical  applications,  matrix  C  is  very  small  in  dimensions.  Therefore  one  way  to 
obtain  E  is  to  evaluate  it  numerically. 

6.2.2.  Evaluation  of  Eq"’.  The  acceleration  constraints  Cq+ Cq  =  0  can  be  written  as 
CEq‘''-CEq“’+  Cq  =  0.  The  first  term  in  this  equation  is  zero  since  CE=K).  The 
identities  in  E  result  in  O's  in  E.  Therefore,  we  have 


6.2.3.  INTEGRATION  OF  THE  EQUATIONS  OF  MOTION 

The  equations  of  motion  expressed  by  equation  41  can  be  put  into  the  stanuard  form  of 
equation  32.  where  y  and  y  arrays  contain  the  independent  joint  coordinates,  velocities, 
and  accelerations  as 


The  process  of  numerical  solution  of  these  equations,  in  general,  is  similar  to  that  presented 
in  section  5.2.  However,  the  intermediate  steps  required  in  evaluating  the  vectors  and 
matrices  for  equation  41  are  more  extensive  Uian  those  of  equations  29  or  37. 


48 


7.  References 


1.  Nikiavesh.  P.  E..  Computer-Aided  Anclvsis  of  Mechanical  Svstems.  Prenuce-Hall. 
1988. 

2.  Kim.  S.  S..  and  Vanderpioeg,  M.  J..  "A  General  and  Efficient  Method  for  Dynamic 
.Analysis  of  Mechanical  Systems  Using  Velocity  Transformaacns. "  ASME  J.  Mech., 
Trans.,  and  Auto,  in  Design,  VoL  108.  NO.  2.  pp.  176-182.  June  1986. 

3.  Sema.  M.  A..  Aviles.  R..  and  Garcia  de  Jalon.  J..  "Dynamic  Analysis  of  Plane 
Mechanisms  with  Lower  Pairs  in  Basic  Coordinates."  Mechanisms  and  Machine  Theory, 
Vol.  7.  No.  6.  pp.  397-403.  1982. 

4.  Garcia  de  Jalon.  J..  Unda.  J..  Avello.  A.,  and  Jimenez.  J.  M..  "Dynamic  Analysis  of 
Three-Dimensional  Mechanisms  in  Natural  Coordinates.”  ASME  Design  Engiiieering 
Technicai  conference.  Columbus.  OH.  October  5-8.  1986.  Paper  No.  86-DET- 137.” 


Symbolic  Computations  in  Multibody  Systems 


W.  SCHIEHLEN 
Institute  B  of  Mechanics 
University  of  Stuttgart 
W-7000  Stuttgart  80 
Germany 

ABSTRACT.  Syznboiic  formula  manipulation  has  proven  to  be  an  efficient  tool  in  the 
dynamical  analysis  of  multibody  systems.  A  multibody  system  data  base  is  introduced 
and  its  implementation  using  a  CAD-3D>software  is  shown.  Starting  from  the  data  base 
the  equations  of  motion  are  generated  by  a  coordinate  partitioning  approach  combined 
with  the  projection  criterion.  For  the  symboiical>numericai  solution  inverse  kinematics 
algorithms  are  applied.  The  simulation  results  are  visuaJized  by  computer  animation.  A 
four-bar  mechanism  and  a  crank-slider  mechanism  serve  as  examples. 


1  Introductioi. 

An  integrated  approach  for  modeling,  generation  of  symbolical  equations  of  motion, 
simulation  and  visualization  of  multibody  systems  is  described.  A  general  object- 
oriented  data  model  for  all  multibody  formtdisms  is  presented.  With  respect  to 
existing  C.'^D-interfaces,  different  solid  model  design  methods  and  various  visuali¬ 
zation  demands,  the  data  model  allows  multibody  modeling  with  a  direct  interface 
to  a  data  base.  Some  software  tools  like  an  integrated  Newton-Euler  formalism  are 
able  to  use  immediately  the  parametrized  multibody  system  data  base.  For  multi¬ 
body  systems  with  closed  kinematic  loops  a  set  of  ordinary  differential  equations  is 
formulated  automatically  which  can  be  solved  with  explicit  multistep  integration  al¬ 
gorithms.  This  is  achieved  by  different  minimal  sets  of  generalized  coordinates  being 
specified  by  a  coordinate  partitioning  approach  during  the  numerical  integration. 
The-basic  steps  and  the  extreme-flexibility  of  thirautomated  mech2mical  design  and 
simulation  process  is  demonstrated  for  mechanisms. 

Machines,  .mechanisms,  road  vehicle.s  and  spacecrafts  can  be  modeled  properly  as 
multibody  systems  for  the  design  and  the  dynamical  analysis.  The  complexity  of 
the  dynamical  equations  called  for  the  development  of  computer-aided  formalisms 


a  quarter  of  a  center  ago.  The  theoretical  background  is  today  available  from  a 
number  of  textbooks  authored  e.g.  by  Roberson  and  Schwertassek  [Ij,  Xikravesh 
!2j,  Haug  [3]  and  Shabana  [4].  The  state-of-the-art  is  also  presented  at  a  series  of 
lUTAM/IAVSD  symposia,  documented  in  the  corresponding  proceedings,  see,  e.g. 
Kortum  and  Schiehlen  [5].  Bianchi  and  Schiehien  (6j,  Kortiim  and  Sharp  (7]. 

In  addition,  a  number  of  commercially  distributed  computer  codes  was  developed,  a 
summary  of  which  is  given  in  the  Multibody  System  Handbook  [8).  The  computer 
codes  available  shows  different  capabilities:  some  of  them  generate  only  the  equa¬ 
tions  of  motion  in  numerical  or  symbolical  form,  respectively,  some  of  them  provide 
numerical  integration  and  simulation,  too.  Moreover,  there  are  also  extensive  soft¬ 
ware  systems  on  the  market  which  offer  additionally  graphical  data  input,  animation 
of  body  motions  and  automated  signal  data  analysis. 


2  Multibody  systems  data  model 

Modeling  of  a  mechanical  system  by  the  method  of  multibody  systems  is  characteri¬ 
zed  by  a  composition  of  rigid  bodies,  joints,  springs,  dampers,  and  servomotors,  see 
Figure  1.  Force  elements  like  springs,  dampers,  and  servomotors  acting  in  discrete 
nodal  points  result  in  applied  forces  and  torques  on  the  rigid  bodies.  Joints  with 
different  properties  connecting  the  various  bodies  constrain  their  motion,  they  are 
often  identified  as  constraint  elements. 


For  the  generation  of  the  equations  of  motion  computer  programs  may  be  used.  Well 
known  multibody  system  computer  codes  producing  exclusively  numerical  data  are 


ADAMS.  Orlandea  (9],  and  DADS.  Haug  (10).  To  the  contrau'v,  computer  programs 
like  SD-FAST,  Rosenthal  and  Sherman  (11)  and  NEWEUL,  Kreuzer  [12J  provide  the 
explicit  symbolical  expressions  for  the  system  equations. 

Nowadays  CAD-systems  are  widely  embedded  in  the  industrial  design  and  construc¬ 
tion  process,  while  a  general  application  of  three-dimensional  CAD-systems  is  still 
rare.  They  support  an  analytically  and  topologically  complete  modeling,  a  collision 
detection,  and  the  calculation  of  surface  and  volume  properties  closely  related  to  the 
geometric  representation  of  solid  models. 

Some  couplings  of  solid  modelers  with  multibody  simulation  software  are  realized 
for  the  numerical  computer  code  ADAMS,  e.g.  for  the  CAD-system  .ARIES  [13].  A 
CAD-3D-system  independent  approach  is  included  in  the  program  package  RASN.\ 
and  is  described  by  Kodar  and  Rosenthal  (14). 

A  system  dynamics  analysis  requires  as  basic  parameters  mass,  center  of  gravity,  and 
moments  of  inertia  of  each  body  related  to  the  geometry  model  and  modeling  method 
of  the  C.AD-system  used.  A  modular  software  concept  demands  an  exchange  of  com¬ 
plete  or  single  object  data  between  the  CAD-system  and  the  multibody  formalism. 
Therefore,  a  general  interface  to  multibody  computer  codes  is  demanded  to  serve  as 
a  compatible  and  comfortable  CAD-post  processor,  taking  the  different  algorithms 
and  implementations  of  multibody  computer  codes  into  account.  The  commercially 
available  multibody  modeling  software  tools  within  CAD-systems  are  mostly  dedi¬ 
cated  to  a  particular  multibody  dynamics  computer  code.  Often,  no  options  are 
supplied  for  a  parametric  raultibody  system  description  or  the  modeling  is  restricted 
to  either  robot,  mechanism  or  vehicle  dynamics.  This  variety  of  systems,  each  with 
different  model  data  and  the  growing  problems  in  the  exchange  of  data,  requires  the 
development  and  production  of  cheaper  and  more  reliable  software  products. 

Consequently  this  leads  to  a  database  concept  for  the  CAD-3D-modeling  of  multi- 
body  systems,  see -Figure  2: 


•  Collect  the  necessary  data  describing  uniquely  a  multibody  model  for  the  dif¬ 
ferent  multibody  programs. 

•  Examine  the  different  geometry  models  of  CAD-systems  for  solids  and  extract 
the  relevant  data  for  multibody  systems. 

•  Define  a  geometry  model  for  the  representation  of  multibody  elements. 

•  Design  data  types  and  operations  and  construct  a  software  interface  for  a  code¬ 
independent  modeling  of  multibody  systems. 


53 


i 

I 

< 


r 


1  I 


CAD  and  Preprocessing 


NEWEUL 


NEWSIM 


Visualization 


Analysis  and  Synthesis 


>— 

“k 

■J 

-eC 

-k 

ea 

mJ 

< 

>- 

O 

Figure  2:  Modules  within  the  database  concept 

A  dynamic  simulation  environment  for  multibody  systems  represents  in  practice  a 
large,  sophisticated  software  system.  Therefore,  an  important  step  is  the  definition  of 
an  abstract  data  model  on  a  conceptual  level.  A  first  effort  to  develop  a  generalized 
data  model  for  multibody  systems  including  symbolical  parameters  and  a  postpro¬ 
cessing  of  CAD-data  is  described  by  Otter,  Hocke,  Daberkow,  and  Leister  (15).  Each 
of  the  bodies  is  described  by  body-fixed  reference  frames.  Further  body-fixed  frames, 
related  joints  and  force  elements  are  described.  Additional  symbolical  parameters 
are  defined  for  the  position  and  orientation  of  the  frames  with  respect  to  each  other 
as  well  as  the  mass  properties  of  the  bodies.  Consequently,  for  symbolical  as  well  as 
numerical  formalisms  a  generalized  data  base  relies  upon  the  basic  modeling  elements 
frame,  body,  joint,  and  force  and  is  further  adapted  and  extended  with  respect  to 
the  geometry  models  in  CAD-3D  and  graphics  systems. 

property  of  a  solid  in  a  CAD-3D  system  can  be  derived  from  a  face  normal  spe¬ 
cifying  the  inner  and  outer  pauts  of  an  object,  while  the  coincidence  of  the  vertices  of 
adjoining  faces  is  not  guaranteed.  The  geometric  modeling  by  parametrized  shapes 
is  appropriate  for  geometric  objects,  whose  shape  is  uniquely  defined  by  a  restriced 
number  of  parameters.  Examples  of  parametrized  shapes  with  an  equivalent  wire 
representation  are  shown  in  Figure  3. 

For  the  global  properties  volume,  surface  area,  moment  of  inertia,  and  center  of 
gravity  of  solid  models,  integrals  have  to  be  evaluated  like 
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=  /  fdV 
Jsolid 


(1) 


see  e.g.  Mortenson  (16),  where  =  f''{x,y,z)  denotes  a  scalar  property  function. 
While  Constructive  Solid  Geometry  suggests  the  calculation  of  mass  properties  by 
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the  following  recursively  applied  formulas 

/  fdV  =  /  fdV  +  /  fdV  -  / 

JSoUiluSol>d2  JSatidl  JSoItdi  Js 


Sohdir\Sol\d2 


fdV. 


I  fdV  =  [  fdV-  I  fdV. 

J  Solxd\~‘SoUd2  J  Solidl  J  SolidloSolid2 

boundary  representations  allow  the  evaluation  via  surface  integrals. 


(2) 


Figure  3:  Parametrized  wire  representations  of  multibody  elements 


The  examination  of  different  geometry  models  yield  the  following  results: 

•  Mass  property  calculation  modules  for  multibody  systems  do  not  depend  on 
the  model  geometry  (CSG  or  B-Rep).  These  results  can  be  related  directly 
with  the  input  entities  needed  for  the  rigid  bodies. 

•  A  planar  face  model  derived  from  the  geometric  entities  of  the  solid  body 
yield  the  graphic  data  for  the  description  of  the  body’s  shape  necessary  for 
visualization. 

•  The  parametrized  shapes  are  well  suited  to  serve  as  a  geometry  model  for 
multibody  modeling  elements  like  frame,  joint,  and  force. 

The  object-oriented  data  model  conceptually  developed  by  Otter  et  eiI.  [loj  results 
in  classes  defined  for  the  elements  part,  frame,  body,  interact,  joint,  force,  global,  and 
param  and  additional  operations  valid  for  these  classes. 

An  object  of  class  body,  e.g.  Figure  4,  comprises  alle  time-invaricint  data  of  a  rigid 
body.  It  is  obvious  that  the  components  inertia  matrix  and  mass  of  an  object  of 
class  body  are  supplied  by  their  numerical  values,  too.  A  location  of  the  center  of 
gravity  different  from  the  body-fixed  reference  frame  is  taken  into  consideration  by 
reference  to  an  equivalent  object  of  class  frame. 

Coupling  elements  of  a  multibody  system  are  collected  in  class  interact.  Interactions 
are  valid  between  two  objects  of  class  frame  on  different  objects  of  class  part. 
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Technical  svstem  I  jmuldbodv  mcdelj  |  class  descnption 


insunce  ot  class 


object:  bodvl 
name  component 


class:  body  name  component  | 

name  jtype  description 

- r— — I -  mass  , - 

mass  dparam  mass  of  body  0.418 

mfrtme  name  c.o.g  frame  mframe  ’ ' 

inertia  dparami6)  inertia  tensor  111,122,133.112,113,123 

- - inertia - 

iframe  name  tensor  frame  113.0,1296  49.1380.67 


Figure  4:  Object  of  class  body  with  its  data  model 

Due  to  object-oriented  software  techniques,  the  definition  of  ab.stract  data  types  in 
classes  furthermore  demands  a  description  of  the  operations  valid  on  the  objects. 
These  operations  are  designed  for  a  practiced,  interactive  multibody  modeling  pro¬ 
cess.  e.g.  in  a  CAD-3D-system.  For  ail  classes  the  basic  operations  ‘create’,  ’delete’, 
‘modify’,  and  ‘list’  are  defined,  more  complex  operations  take  the  relationships  bet¬ 
ween  objects  of  a  multibody  system  into  account. 

Further  classes  are  required  for  the  graphical  representation,  like  the  actual  frame 
axis  length,  its  color  or  visibility,  which  depend  on  the  actual  multibody  size  and 
modeling  state.  An  equivalent  geometry  data  model  for  multibody  elements  well 
suitable  for  machine,  robot  and  vehicle  dynamics  requires  a  unique  spatial  represen¬ 
tation  of  the  multibody  elements,  their  function  and  physical  quantity,  see  Daberkow 
[17].  From  Figure  3  it  is  obvious  that  spatial  oarametrized  shapes  satisfy  a  graphic 
representation  for  objects  of  class  frame,  joint,  and  force.  The  definition  of  the  geo¬ 
metry  3D  classes  gSframe,  gSjoint  and  gSforce  and  operations  for  the  geometry  data 
model  is  equivalent  to  the  multibody  data  model  and  includes  classes  comprising 
color,  projection  and  viewpoint  data. 


Implementation  and  CAD-3D-realization 


The  implementation  of  the  object-oriented  data  model  in  the  data  base  system 
RSYST  [18]  allows  storage  and  modification  of  multibody  system  objects.  To  realize 
fast  access  and  interactive  graphic  visualization,  the  implementation  of  the  object- 
oriented  classes  and  operations  within  the  CAD-3D-system  is  performed  by  means 
of  data  types  and  routines,  which  result  in  a  system-independent  modeling  kernel 
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library  for  multibody  systems,  see  Daberkow  [17].  This  high  level  library  DAMOS-C 
(DAta  Model  Standard  implemented  in  C)  supplies  interfaces  for  modeling,  input, 
and  output  as  well  as  for  the  graphic  representation.  This  open  interface  allows  the 
integration  in  the  commercially  available  CAD-3D-  system  SIGRAPH  [19]  and  a  new 
developed  graphics-system. 

The  integration  scheme  in  Figure  5  shows  the  interfaces  to  the  C.AD-3D  software  mo- 
duls  of  SIGRAPH.  An  extension  of  the  CAD  command  language  supplies  additional 
commands  which  are  necessary  for  the  execution  of  multibody  modeling  operati¬ 
ons.  The  CAD-3D-system  menu  is  completed  by  special  multibody  system  icons. 
To  assure  the  graphic  display  of  the  modeling  elements,  the  parametrized  shapes  are 
modeled  via  the  3D-wireframe  entities  of  the  CAD-graphic  subsystem.  A  multibody 
command  language  of  RSYST  serves  as  a  multibody  system  neutral  file  to  store  the 
multibody  objects,  see  Otter  et  al.  (20] 
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Figure  5:  Integration  of  the  multibody  modeling  kernel 


The  solid  model  design  of  a  crank  slider  mechanism  is  performed  by  volume  oriented 
techniques  in  PARASOLID  from  a  disassembled  model.  Figure  6.  All  bodies  of  the 
crank-slider  mechanism  of  a  single  four  stroke  engine  are  shown  in  Figure  6.  Each 
body  is  supplied  with  adequate  density  attributes. 


The  first  multibody  modeling  step  is  the  initialization.  Here,  an  appropriate  solid 
is  chosen  as  the  inertial  body  of  the  multibody  system,  see  Figure  6.  In  the  next 
step  arbitrary  solids  are  interactively  chosen  to  have  the  properties  of  a  multibody 
part.  Each  object  of  class  body  retrieves  its  mass  and  inertia  components  from  the 
mass  property  calculation  modul  of  PARASOLID.  To  visualize  the  multibody  part 
property,  the  equivalent  solids  are  supplied  by  reference  frames,  located  in  the  center 
of  gravity. 

By  default,  the  orientation  of  further  created  joint  and  force  definition  frames  is 
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parallel  to  the  specified  reference  frame.  The  position  of  these  frames  is  defined 
by  the  C.-\D-3D-picking  commands  performed  by  the  user.  Figure  6  shows  these 
modeling  steps  and  the  graphic  representation  of  the  objects.  Joint  definition  frames 


Figure  6;  Disassembled  and  assembled  mechanism  with  joint  and  force  objects 

are  located  along  the  unit  normals  of  those  faces,  which  form  bearing  surfaces  or 
bearing  bores  of  a  solid. 

A  planar  system  modeled  for  spatial  analysis  demands  a  proper  constraint  selection. 
Redundant  constraints  remain  if  a  mechanism  is  supplied  with  joints  of  class  revolute 
and  translational,  making  the  determination  of  reaction  forces  impossible.  Conse¬ 
quently,  for  an  analysis  modified  joints  have  to  be  chosen.  Objects  of  class  revolute 
are  visualized  by  the  parametrized  shapes  and  the  wireframe  entities.  The  connec¬ 
tion  between  the  objects  of  class  part  by  the  object  of  class  interact  is  visualized  by 
a  3D-line  entity  between  the  interacted  frames. 

The  multibody  modeling  kernel  library  implemented  in  the  C  AD-3D-system  supports 
an  assembling  of  arbitrary  pairs  of  class  part.  Figure  6  shows  the  assembling  of 
individud  solids  over  the  equivalent  objects  of  class  joint.  By  modifying  the  rangle 
component  of  arbitrary  objects  of  class  joint,  an  initial  multibody  configuration  is 
adjusted  interactively,  providing  therefore  an  initial  estimate  for  closed  loop  systems. 
Finally,  an  object  of  class  force  general  is  added  to  the  piston  part. 
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Generation  of  equations  of  motion  starting 
from  the  database 


The  generation  of  equations  of  motion  and  the  embedding  of  these  equations  to  simu¬ 
lation  software  is  especially  in  case  of  Izirge  multibody  models  very  time  consuming 
and  prone  of  errors.  Starting  from  the  description  of  the  multibody  system  stored 
on  the  database,  the  modul  NEWEUL,  Kreu2er  and  Leister  [21],  generates  symbolic 
equations  of  motions  and  all  information  necessary  for  the  automatic  simulation. 
The  modul  NEWSIM,  Leister  (22),  uses  in  the  next  step  the  compiled  symbolical 
equations  of  motion  for  the  simulation.  Using  the  object-oriented  datamodel  the 
modules  NEWEUL  and  NEWSIM  are  tools  of  a  modular  software  package  of  the 
multibody  system  approach,  see  Figure  7. 

In  a  first  step  the  information  stored  in  the  database  has  to  be  extracted.  In  a 
modular  concept  the  generation  of  equations  of  motion  and  the  simulation  have 
to  be  separated.  The  datamodel  includes  all  the  information  neccessary  for  the 
generation  of  the  equations  of  motion  and,  an  adapted  version  of  NEWEUL  can  be 
used  as  module  in  the  database  concept.  Based  upon  a  Newton-Euler  formalism 
the  symbolical  equations  of  motion  are  generated  using  d’Alembert’s  or  Jourdain's 
principle  to  eliminate  the  reactions  forces  and  torques,  see  Ref.  (23).  By  means 
of  a  special,  for  the  multibody  system  approach  developed  formulamanipulator,  it 
is  possible  to  generate  the  equations  of  motion  with  minimed  costs  of  computation 
time,  see  Kreuzer  [12].  The  symbolical  equations  of  motion  can  be  used  on  the  one 
hand  in  the  simulation  environment  NEWSIM  and  on  the  other  hand  in  any  general 
purpose  simulation  environment,  e.g.  ACSL  (24]  or  DSSIM  [25]. 

.At  first,  from  the  objects  interact  and  joint  the  topologv  of  the  multibody  system  is 
computed.  Additionally  from  the  object  joint  the  gf  lized  coordinates  are  deter¬ 
mined.  The  kinematical  description  of  multibody  sysv^ns  is  done  by  the  definition 
of  frames  relatively  to  any  arbitrary  frame.  These  frames  define  rigid  bodies,  joints, 
auxiliary  frames,  and  reference  frames,  too.  Additionally  the  mass-geometric  pro¬ 
perties  cind  the  applied  forces  and  moments  are  neccessary.  These  data  can  be  found 
in  the  objects  interact  and  force,  see  Figure  7. 

The  modul  NEWSIM  serves  for  the  numerical  simulation  of  the  generated  symbolic 
equations  of  motion.  It  is  easy  to  study  the  influence  of  parameters  or  to  opti¬ 
mize  the  dynamical  behaviour  with  respect  to  some  specified  criteria.  NEWSIM  has 
the  possibility  to  treat  additional  differential  or  differential-algebraic  equations.  For 
integration  in  the  time-domain  different  integration  schemes  are  e.g.  Runge-Kutta 
methods.  .Adams-methods.  BDF-methods.  For  multibody  systems  including  clo¬ 
sed  loops  a  modified  .Adams-Bashforth-Moulton  method  is  implemented,  see  Leister 
[261 .  .All  neccesarv  routines  for  tne  automatic  simulation  software  are  generated  by 
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Figure  7:  Dataflow  of  the  datamodel 
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XEWEUL,  Figure  8.  After  the  compilation  and  binding  step  the  problem-specific 
programm  takes  ail  parameters  and  options  from  the  datafile.  This  program  reads  all 
options,  initial  conditions,  fixed  .<!ystem  parameters  like  masses,  moments  of  inertia, 
geometric  data,  stiffness  constants,  and  further  data  from  the  input  file  and  solves 
the  equations  of  motion  of  the  problem. 
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Figure  8:  Simulation  of  the  dynamic  behaviour  with  NEWEUL  and  NEWSIM 


5  Formalism  for  multibody  systems  using  coor¬ 
dinate  partitioning 


Modeling  dynamical  systems  by  the  method  of  multibody  systems  results  in  either 
ordinary  differential  equations  (ODEs)  using  minimal  coordinates  or  coupled  diffe¬ 
rential  and  algebraic  equations  using  cartesian  and  redundant  coordinates  (DAEs). 
Often  ODEs  are  integrated  numerically  by  explicit  multistep  integration  algorithms 
whereas  DAEs  have  to  be  integrated  by  implicit  or  halfimplicit  methods.  Numeri¬ 
cal  experiments  have  shown,  Leister  [26).  that  the  integration  algorithms  for  ODEs 
seems  to  be  more  efficient  than  algorithms  for  DAEs.  Thus,  it  is  advantageous  to 
describe  multibody  systems  by  a  minimal  number  of  pure  differential  equations,  the 
so-called  state  space  form. 


Consider  a  mechanical  system  modelled  by  e  generalized  coordinates  x  = 
[xi.....Xe|^  and  subject  to  q  holonomic  constraints  renresented  by  at  least  twice 
differentiable  functions  #(*,  t)  =  t),...,  4, (a:,  f  )i^-  The  governing  equations 

of  constrained  motion  of  the  system  cem  be  written  in  the  following  DAE  form,  see 
e.g.  Ref.  [23j 


M{x,t)x  =  h{x,x,t)->rQ{x,t)  g  ,  (3) 

^x,i)  =  0,  (4) 

where  M  is  the  e  x  e  symmetric  positive-definite  mass  matrix:  h  represents  the 
components  of  applied  forces  on  the  system  and  the  gyroscopic  terms:  =  C  = 

5#/3x  is  the  qx  e  constraint  matrix;  and  g  =  [Ai,...,A,]^  conserves  Lagrange 
multipliers  or  generalized  constraint  forces,  respectively.  The  constraint  equations 
(4)  can  be  differentiated  to: 


^  =  C(®,<)  i -r  a(x,f)  =  0,  (5) 

=  C{x,()  X -f  6(x,x,t)  ss  0,  (6) 

where  a  =  d^ldt,  eind  b  =  Cx  +  a. 

The  coordinate  partitioning  method  makes  use  of  the  fact  that  only  f  —  e  —  q 
from  the  e  initial  coordinates  x  are  independent,  denoted  y  =  [j/i, •  •  •  .y/]^;  the 
others  are  refered  to  as  the  dependent  coordinates  in  the  meaning  of  this  method, 
xd  =  [xDi,  •  •  •  ,XDq]^-  Thus,  according  to  the  symbolic  partition, 

x  =  [y^  xlf ,  (7) 

the  constraint  equations  (5)  can  be  rewritten  as 

C/(x,f)  y -f  CD(x,t)  X£) -f  a(x,')  =  0.  (8) 


For  clarity  in  the  mathematical  formulation,  this  symbolic  notation,  partitioned  re¬ 
lative  to  independent  and  dependent  coordinates,  will  be  used  through  the  whole 
paper.  In  numerical  algorithms,  however,  it  is  usually  more  convenient  to  complete 
this  task  by  assigning  appropriate  addresses  to  the  entries  of  matrices  and  vectors 
being  partitioned. 

If  constraints  (4)  are  independent,  rank{C)  =  q,  there  exist  at  least  one  set  of  xp 
such  that  the  corresponding  square  submatrix  Co  is  nonsingular.  det{Cc>)  0. 
This  enables  one  to  express  xd  as  linear  combinations  of  y,  and  then  xo  as  linear 
combination  of  y,  i.e.r 

Xd  =  -C5*(C/y -i- a)  =  A{x,f)  y  ■t-T7(x.f),  (9) 

Xd  =  A(x,t)y-i-^{y,x.t).  (10) 
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Using  (9)  and  (10).  tbe  following  interdependences  between  the  initial  and  indepen¬ 
dent  velocities  and  accelerations  can  be  introduced: 


where  denotes  the  /  x  /  identity  matrix;  and  0  is  the  /-dimensional  null  vector. 


The  /  :;  e  matrix  D{x,t)  is  a  priori  of  maximal  rank,  and  is  an  orthogonal  comple¬ 
ment  matrix  to  the  constraint  matrix  C  in  the  c-space  of  the  system's  configuration, 
i.e.  DC^  =  0.  Tfi'iis,  the  columns  of  are  (contravariant)  components  of  vectors 
dj{j  =  1, . . . ,  /)  which  span  the  tangent  suhspace  in  the  e-space.  On  the  other  hand, 
the  columns  of  tire  (covariant)  components  of  constraint  vectors  c,  (i  =  1.  ..q) 
which  span  the  orthogonal  (or  constrained)  subspace.  The  tangent  and  orthogo¬ 
nal  subspaces  complement  each  other  in  the  e-space,  and  DC^  —  0  expresses  the 
orthogonality  conditions  dy  •  c.  =  0  (;  =  1(1)/;  i  =  1(1)9)-  Since  of  linear  inde¬ 
pendence,  ^,...,dy  span  a  new  base  Bcj  =  [ej  ej|  in  the  e-space. 

where  Ce  =  [ci,...,c,]  and  =  [^,...,d/|  are  the  base  vectors  of  orthogo¬ 
nal  and  tangent  subspaces,  respectively.  The  transformation  formula  between  the 
(covariant)  bases  and  e*  is 


Scd 


CM-^ 

D 


Cg  —  T cd  » 


(13) 


where  Ct  =  are  the  base  vectors  spanning  the  directions  of  x.  The 

appearance  of  M~*  in  the  upper  part  of  Tai  comes  evident  after  a  little  inspection. 
Since  contains  covariant  components  of  the  base  vectors  of  tbe  orthogonal  sub¬ 
space.  the  transformation  between  the  covariant  base  vectors  and  e-  requires  the 
CM~'  formula.  On  the  other  hand.  contains  contravariant  components,  and 
the  transformation  between  ej  and  c-  is  defined  by  matrix  D.  For  details  refer  to 
Blajer  (27]. 


Using  the  above  definitions,  the  dynamic  equations  (3)  can  be  projected  into  the 
base  e^,  which  is  equivalent  to  the  left-sided  premultiplication  of  these  equations  by 
Td-  The  tangential  projection  (into  Ci  base),  after  considering  (11)  and  (12),  leads 
to  the  minimal  set  of  constraint  reaction-free  (or  canonical)  dynamic  equations  in 
independent  coordinates 

Mi{x,t)y  =  hi{y,x,t),  (14) 

where 

Mi  =  DMD^.  (15) 

hi  =  D{h-M\Q^fY)  ■ 
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As  M  is  the  metric  tensor  matrix  of  base  e*,  the  metric  tensor  matrix  of  base  e., 
can  be  written  as 


M 


ed 


TciMT 


r  cM-‘c^ 

0 

'  M.  o' 

[ 

DMD^ 

0^  Mi 

■17) 


where  A/c  =  CM~^C^  and  Mi  =  DMD^  are  the  metric  tensor  matrices  of  bases 
Ce  and  ti,  respectively;  and  0  is  the  9  x  /  null  matrix.  The  above  relation,  which 
will  be  of  use  in  the  following,  indicates  that  the  orthogonal  and  tangent  subspaces 
really  complement  each  other  in  the  e*space. 

By  appending  y  —  v  to  (14),  2/  first-order  differential  equations  in  v  and  y  fol¬ 
low.  However,  since  Mi  and  hi  depend  on  all  initial  coordinates  x,  the  constraint 
equation  (4)  have  to  be  solved  at  each  step  of  integration  for  xq  as  function  of  the 
current  values  of  y,  and  this  process  is  usually  computationally  expensive.  Thus,  it 
is  recommendable  to  integrate  (14)  together  with  the  kinematic  relations  (11).  and 
solve  the  /  -i-  e  first-order  differential  equations  directly  for  i;(=  y)  and  x.  Obvi¬ 
ously,  such  an  integration  process  may  lead  to  violatio.  o‘'  constraint  equations  (4). 
In  order  to  minimize  the  phenomenon,  Baumgarte’s  constraint  stabilization  method 
(28]  in  its  form  by  Ostermeyer  [29]  can  be  used.  According  to  this  method,  (6)  can 
be  rewritten  as 


#  =  C(x,f)  X  ■k-h{x,Zyt)->r  K\  ^{x,t)  +  Ko  f  #(*,<)  df  =  0 

Jto 


(18) 


where  Ki  and  Ko  q  x  q  diagonal  matrices  of  feedback  gains.  Note  that  by 
attaching  (11)  to  (14),  the  first-order  kinematic  constraint  equations  (5)  are  satisfied 
in  principle,  #  =  0;  the  resolved  form  of  these  equations  is  equivalent  to  (11).  Thus, 
the  corresponding  stabilization  term  Kjf  s  0  will  not  appear  in  the  scheme  (IS), 
which  is  then  a  Pl-controller  scheme.  .4s  shown  in  (29),  the  integral  stabilization 

term  Ko  j  ^dt  is  of  great  importance  in  such  a  scheme. 

Implem''nting  (18),  the  final  governing  equation  of  motion  of  the  system  can  be 
written  as  follows: 


Mi(x,t)  i!  =  hi{v,z,t), 


X  =  D^{x,t)  V  + 


0 


where 


hi  =  Dh-  DM 


4  +  {Ki^  I 


(19a) 

(196) 

(20) 


To  overcome  the  stability  problem  related  to  the  method  described,  the  projection 
criterion  will  be  presented  for  a  proper  choice  of  the  independent  coordinates  and  a 
symbolical  inverse  kinematics  approach  will  be  proposed. 


6  Projective  criterion  for  coordinate  partitioning 

The  projective  criterion  for  coordinate  partitioning  proposed  in  this  paper  deals  with 
a  system’s  configuration  space  which  is  not  a  Cartesian  one  but  an  e-dimensional 
Riemannian  space.  The  norm  of  a  vector  in  such  a  space  has  thus  to  be  redefined 
according  to  the  vector  space  algebra.  The  aspects  of  contravariant/covariant  vec¬ 
tor  representations  are  of  importance  for  this  definition  and  for  the  further  base 
transformations  in  the  e-space,  see  e.g.  Blajer  {27j.  The  transformation  matrix 
Ted  defined  in  (13)  is  the  mapping  of  the  covariant  representations  k'  of  vectors 
k,  =  fi-Je;  (1  =  l(l)e). 


into  base,  i.e. 


j -  i-th  position 

fc*  =  [0,... ,0,1,0 . of. 


(21) 

(22) 


The  vector  k,  defined  this  way  can  be  interpreted  as  a  unit  vector  along  x,  direction, 
i  •  fc,  =  x^k'  =  X,,  and  this  elucidate  its  (covariant)  representation  in  (21).  Then, 
it  comes  from  (22)  that  the  i-th  column  of  CM"'  is  the  (covariant)  representation 
of  k,  in  e!  base,  whereas  the  i-th  column  of  D  is  the  (covariant)  representation  of 
fc,  in  ej  base.  Denoting  these  representations  by  k'^‘^  and  k‘^^\  respectively,  it  can 
be  written  that; 


(23) 


Using  generalized  scalar  products.  and  can  be  written  as  follows: 

\k,\^  =  kfM-'k:  = 

!^(c)p  ^  (24) 

where  is  the  :tth  entry  of  M~^;  and  Me  and  Mi  are  defined  in  (17). 

Basing  on  (24),  the  following  generalized  formulation  of  the  projective  criterion  for 
coordinate  partitioning  can  be  introduced: 


cos^  Of,-  = 


1^ 

|fc.P 


(25a) 


COS^  0i 


■  M-%i) 


(256) 


The  bigger  cos^  O',-  (  the  smaller  cos^  I3{)  the  closer  is  k^  to  the  tangent  hyperplane 
and  the  better  x,  as  an  independent  coordinate. 


In  fact  two  formulae  for  the  reported  criterion  have  been  introduced,  (25a)  and 
(25b).  Respectively,  they  express  the  rquared  cosines  (generalized  to  the  e-spaces) 
of  angels  between  the  vector  ki  and  its  projections  k^'^^  and  into  the  tangent  and 
orthogonal  subspaces.  The  matrix  Mi  used  in  (25a)  is  actually  the  mass  matrix 
of  the  minimal-dimension  dynamic  equations  (14)  or  (19a),  and  thus  is  available 
(more  or  less  explicitly)  in  its  inverted  form  at  each  instant  of  the  system  motion 
simulation.  The  matrix  Me  —  CM~^C^  used  in  (25b)  has  to  be  formulated  and 
inverted  individually.  Therefore,  the  formulation  (25a)  is  recommendable  for  the 
reported  formulation. 

For  the  current  set  y,  the  reported  criterion  can  be  applied  occasionally  to  check 
or  redefine  the  choice  for  y  as  related  those  components  of  x  whose  corresponding 
cos^  a,  (i  =  1, . . . ,  e)  have  the  biggest  values. 


7  Application  of  inverse  kinematics  algorithms 

The  essenticil  shortcoming  of  the  coordinate  partitioning  method  is  the  necessity  of 
inverting  Co  in  order  to  determine  A  =  —C^Ci,  j]  =  Cp^a,  and  ^  =  C'pb. 
required  for  the  formulation  of  equations  (12)  or  (17),  During  the  simulation  process 
Cp  has  to  be  inverted  at  each  step  of  integration,  and  this  may  bring  some  inefficiency 
in  computations. 
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h  this  section  advantages  are  emphasized  that  may  arise  in  the  coordinate  par¬ 
titioning  approach  to  the  dynamic  analysis  of  constrained  mechanical  systems  by 
adapting  special  algorithms  of  inverse  kinematics  developed  in  the  field  of  robotics,, 
and  of  remarkable  importance  is  a  technique  developed  by  Woernle  [30].  .\ccording 
to  this  technique,  the  kinematic  chains  are  parted  into  two  open  chains  so  that  to 
select  relations  with  a  reduced  number  of  unknowns.  Then,  setting  some  coordinates 
to  be  frozen  (independent),  the  recursive  relations  for  the  other  (dependent)  coor¬ 
dinates  as  function  of  the  frozen  ones  are  found  without  introducing  the  constraint 
equations  in  the  form  (4),  see  also  Eppinger  and  Kreuzer  [31],  and  Blajer,  Schiehlen 
and  Schirm  [32],  and  Schiehlen  and  Blajer  (33).  These  recursive  relations  are  denoted 
symbolically  cis 

XD  =  XDiy,t),  (26) 

and  are  recognized  also  as  closing  conditions,  Ref.  [34].  In  fact,  (26)  are  often  quite 
comple.x.  and  the  amount  of  labour  required  for  their  derivation  depends  greatly  on 
the  skill  of  the  investigator  in  using  the  inverse  kinematics  procedures.  Nevertheless, 
this  initial  work  pays  in  the  further  analysis.  The  (recursive)  relations  for  (9)  and 
(10)  are  usually  not  so  laborious  to  be  obtained  analytically.  They  can  also  be  derived 
by  using  computer  symbolical  formalisms  like  NEWEUL  [8],  [21]. 

The  application  of  inverse  kinematics  algorithms  benefits  in  analytical  (though  recur¬ 
sive)  formulae  for  x/j.  A,  tj  and  $.  This  accelerates  usually  the  numerical  formulation 
of  the  tangent  dynamic  equations  (14),  and  the  final  governing  equations  of  motion 
can  be  written  in  the  following  simplified  2 /-order  form: 

Md{y)  V  ==  hd{v,y,t)  ,  (27o) 

y  =  v  (276) 

where  and  hi  correspond  to  Mi  and  hi  defined  in  (15)  and  (16)  after  substi¬ 
tuting  X  =  [y^  and  y  =  {A{y,t)v  -i-  T7(y,  d))^]’",  where 

A(y,  t),  ri{y,  d)  and  ^{v,  y,  d)  represent  the  recursive  formulae  from  the  inverse  kine¬ 
matics.  Note  that  the  closing  conditions  (26)  replace  the  constraint  equations  (4), 
i.e.  it  can  be  written 

i{x,t)  =  -XD{y,t)  +  XD  =  0.  (28) 

Thus,  the  solution  of  (27)  is  released  from  the  problem  of  constraint  violation.  Note 
also  that,  as  all  the  entries  of  x  and  x  are  determined  at  each  step  of  integration  of 
(27),  an  eventual  transition  from  one  set  of  y  to  .another  will  not  yield  any  inconsi¬ 
stency  in  the  initial  value  problem  of  accordingly  reformulated  governing  equations. 
Obviously,  an  appropriate  number  of  recursive  formulae  (26),  (9)  and  (10)  for  diffe¬ 
rent  possible  (or  all)  sets  of  y  from  x  has  to  be  prepared  in  advance. 

Consider  the  planar  four-bar  linkage  shown  in  Fig.9.  In  order  to  build  an  open-loop 
system,  each  of  the  joints  0,  {i  =  1(1)4)  can  be  cut.  yielding  a  one  branch  or  two 


67 


Figure  9:  Four- bar  n^echanism 

branch  tree,  respectively.  The  coordinates  x  of  the  unconstrained  system  can  also 
be  defined  differently.  In  the  example  case,  the  mechanism  was  cut  in  joint  O4  and 
the  relative  coordinates  x  —  [ai  oj  aap  have  been  chosen  to  represent  a  planar 
manipulator  with  the  end-effector  fixed  in  point  O4.  The  dynamic  equations  of  the 
system,  corresponding  to  (14),  will  not  be  reported  here. 

The  constraints  of  the  system  can  be  expressed  either  implicitly  by  constraint  equa¬ 
tions  (4)  or  explicitly  by  closing  conditions  (26),  which  yields  respective  formulations 
of  matrix  D  defining  the  tangent  subspace.  In  the  following  an  application  of  in¬ 
verse  kinematics  algorithms  leading  to  recursive  relations  for  the  closing  conditions 
will  be  demonstrated.  The  subsequent  derivation  for  the  simple  example  bases  on 
the  approach  given  by  Woernle  [30].  According  to  the  approach,  the  mechanism  is 
separated,  by  cutting  in  joints  O2  and  O4,  into  the  lower  and  upper  segments,  and 
the  closure  condition  is 


^touicf  ®  Slower  ^}tpper  ®  Supper  —  0  ,' 


(29) 


where  f lower  ■=  OiO^-OiOj,  f upper  ■=  O3O2— O3O4.  Due  to  the  used  segmentation, 
(29)  depends  on  ai  and  03  (does  not  depend  on  oj),  and  only  one  of  these  coordinates 
can  be  chosen  for  an  independent  one  in  the  subsequent  derivation  (the  choice  y  = 
[oj]  would  require  a  different  segmentation).  Here,  the  relations  (26),  (11)  and  (12) 
are  reported  only  for  y  =  [ajj. 

Solving  (29),  one  obtaines 


Q3  =  ±  circcos 


/  (q  +  /i  -  -  I3  -  2/0(1  sin  Qi 

I  2hh 


(30) 
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The  relations  (30)  and  (31)  express  recursively  03(01)  and  02(01)  as  defined  in  (26). 
Differentiation  of  these  closing  conditions  leads  to: 


IqIi  cos  Oi  . 

Q3  =  Ti — : - ' 

hh  sm  03 

(32) 

/oCOS(Qi  +  02)  . 

02  =  - : - Oi  -  O3  , 

<3  Sin  03 


and  therefore,  the  matrix  D  defined  in  (11)  can  be  stated  as 


in  Fig.lO.  The  linkage  geometry  was  set  to  assure  that  the  choice  y  =  [ai]  never 
leads  to  a  singularity,  enabling  one  to  plot  the  results  throughout  the  whole  range 
ai  €  <  0, 2;:  >.  As  seen,  both  Oi  and  aj  are  acceptable  choices  for  y  in  any  linkage 
configuration,  none  of  them,  however,  can  be  assigned  to  be  the  best  independent 
coordinate  over  the  hole  range  of  Qj.  It  is  evident,  also,  that  the  choice  y  =  [03]  is 
the  worst  as  leading  to  singularities  at  Oj  =  t/2  and  ax  =  3jr/2.  and  due  to  relatively 
small  values  of  tangent  projections. 

The  numerical  .-’mulation  can  now  be  carried  out  in  the  best  independent  coordinate 
according  to  the  projective  criterion,  i.e.  changes  between  the  coordinates  qi  and 
aj  are  necessary  to  ensure  the  integration  with  the  best  coordinate.  This  change 
can  be  done  without  a  loss  in  integration  order  and  stepsize  by  using  a  modified 
Adams-Bashfoith  integration  code. 

8  Visualization  of  simulation  results 

A  convenient  verification  a  dynamic  visualization  of  a  multibody  system  simulation  is 
obtained  by  a  3D  computer  graphics  animation.  Animation  methods  differ  according 
to  the  geometry  model,  rendering  algorithms  and  possible  user  interaction.  The  most 
sophisticated  animation  method  is  achieved  by  rendering  algorithms  like  raytracing 
and  radiosity.  These  rendering  techniques  result  in  realistic  images,  but  suffer  from 
‘.me-consuming  computations.  During  image  display,  no  interactive  modification  of 
the  view  projection  is  possible.  A  raytraced  image  of  the  crank-slider  mechanism  is 
shown  in  Figure  11. 

Most  CAD-3D-systems  offer  modules  for  the  generation  of  images  with  hidden  line 
and  hidden  surfaces  removal  and  shaded  surfaces.  Often,  the  solid  model  and  ren¬ 
dering  algorithms  yield  sophisticated  2D  drawings  for  documentation  purposes,  but 
allow  a  dynamic  visualization  only  in  a  wireframe  mode. 

Consequently  the  unified  approach  to  display  a  broad  variety  of  simulation  result 
for  different  initial  conditions,  visualization  systems  and  applications  is  based  on  the 
planar  face  model.  The  visualization  module  VISANI  for  the  interactive,  high  speed 
animation  of  arbitrary  muitibody  systems  is  described  by  Daberkow  [17].  As  a  result 
of  the  simulation,  a  time  plot  of  the  crankshaft  bearing  force  of  the  mechanism  under 
an  applied  piston  gas  force  and  an  animated  sequence  is  shown  in  Figure  12. 


Figure  11:  Ray  tracing  of  crank  slider  mechanism 


Force  in  Newton 


Figure  12.  Time  plot  and  animated  sequences  of  the  crank  slider  mechanism 
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Conclusion 


la  this  paper  an  integrated  modeling,  simulation  and  visualization  of  multibody  sy¬ 
stem  dynamics  is  introduced.  A  unified  general  data  model  including  the  graphic 
description  is  presented.  To  support  tne  preceding  CAD-3D-modeling  stage,  a  unified 
spatial  graphic  representation  for  multibody  elements  is  designed.  Object-oriented 
classes  and  operations  are  then  implemented  in  a  system  independent  multibody 
modeling  kernel  library  and  integrated  in  a  commercied  CAD-3D  system.  From  the 
multibody  model  data  base,  an  integrated  Newton-Euler  formalism  generates  a  set 
of  symbolical  ordinary  differential  equations,  which  are  solved  by  explicit  multistep 
integration  algorithms.  Thereby,  a  minimal  set  of  generalized  coordinates  is  specified 
during  numerical  integration  without  restart  of  the  integration  algorithm,  using  the 
projection  method  within  the  coordinate  partitioning  approach.  The  final  visualiza¬ 
tion  of  the  crank  slider  mecl  mism  demonstrates  that  this  integrated  approach  fits 
the  criteria  of  a  modular,  automated  design  and  simulation  environment. 


References 

[1]  Roberson,  R.E.,  Schwertassek,  R.:  Dynamics  of  Multibody  Systems. 

Berlin:  Springer  1988. 

[2]  Nikravesh,  P.E.:  Computer-aided  Anedysis  of  Mechanical  Systems. 

New  Jersey:  Prentice-Hall  1988. 

[3]  Haug,  E.J.:  Computer-aided  Kinematics  and  Dynamics  of  Mechanical  Systems. 
Boston:  Allyn  and  Bacon  1989. 

[4]  Shabana,  A.:  Dynamics  of  Multibody  Systems.  New  York:  Wiley  1989. 

[5]  Kortum,  W.;  Schiehlen,  W.:  General  purpose  vehicle  system  dynamics  software 
based  on  midtibody  formalisms.  Vehicle  System  Dynamics  14(1985), 

pp.  229-263. 

[6]  Bianchi,  G.;  Schiehlen,  W.  (eds.):  Dynamics  of  Multibody  Systems. 

Berlin:  Springer- Verlag  1986. 

[7]  Kortum,  W.;  Sharp,  R.  S.:  A  report  on  the  state-of-affairs  on  application  of 
multibody  computer  codes  to  vehicle  system  dynamics.  Vehicle  System  Dyna¬ 
mics  20,  pp.  177-184,  1991. 

[8]  Schiehlen.  W.  (ed):  Mult,body  Systems  Handbook.  Berlin.  Springer-Verlag 
1990. 


72 


[9]  Orlandea.  X.:  Xode-Analogous  Sparsity-Oriented  Methods  for  Simulation  of 
Mechanical  Systems.  Ph.D.  dissertation.  University  of  Michigan.  1973. 

[10]  Haug,  E.J.:  Computer  .Aided  Kinematics  and  Dynamics  of  Mechanical  S'-stems. 
.Allyn  and  Bacon.  Boston,  M.A,  1989. 

[11]  RosenthzJ.  D.E..  Sherman.  M.A.;  High  performance  multibody  simulation  via 
symbolic  equation  manipulation  and  Kane’s  method.  Journad  of  Astronautical 
Sciences,  34,  pp.  223-239,  1986. 

[12]  Kreuzer,  E.:  Symbolische  Berechnung  der  Bewegungsgleichungen  von 
Mehrkorpersystemen,  Fortschr.-Ber.  der  VDI-Zeitschriften.  Reihe.  11,  Xr.  32. 
Dusseldorf:  VDI-Verlag,  1979. 

[13]  ARIES  Conceptstation  Software  Simulation  Mechanism  Reference.  .Aries  Tech¬ 
nology  Inc..  Lowell,  MA,  1990. 

[14]  Hollar,  M.G.:  Rosenthal,  D.E.:  Concurrent  Design  and  .Analysis  of  Mechanisms. 
Rasna  Corporation,  San  Jose,  CA,  1991. 

[15]  Otter,  M.;  Hocke,  M.;  Daberkow,  A.;  Leister,  G.:  Ein  objektorientiertes  Da- 
tenmodell  zur  Beschreibung  von  Mehrkorpersystemen  unter  Verwendung  von 
RSYST.  Stuttgart:  Universitat,  Institut  B  fur  Mechanik,  IB- 16,  1990. 

[16]  Mortenson,  M.E.:  Geometric  Modeling.  John  Wiley,  New  York,  1985. 

[17]  Daberkow,  A.:  Zur  CAD-gestutzten  Modellierung  von  Mehrkorpersystemen. 
Ph.D.  Dissertation,  Stuttgart,  1992. 

[18]  Ruble.  R.;  RSYST,  ein  integriertes  Modulsystem  mit  Datenbasis  zur  automati- 
schen  Berechnung  von  Kernreaktoren.  Stuttgart:  Universitat.  IKE  4-12  1973. 

[19]  SIGRAPH-CAD-3D.  SIEMENS  NIXDORF  AG.  Munchen.  1992. 

[20]  Otter,  M.:  Hocke.  M.;  Daberkow,  .A.:  Leister.  G.:  An  object  oriented  data-model 
for  multibody  systems.  In:  Advanced  Multibody  System  Dynamics.  Dordrecht: 
Kluwer  1993.  pp. 19-48. 

[21]  Kreuzer,  E.;  Leister,  G.:  Programmsystem  NEWEUL’90.  .Anleitung,  Stuttgart: 
Universitat.  Institut  B  fiir  Mechanik,  AN-24,  1991. 

[22]  Leister,  G.:  Programmpaket  NEWSIM.  Stuttgart:  Universitat.  Institut  B  fiir 
Mechanik,  .AN-25.  1991. 

[23]  Schiehlen.  W..:  Technische  Dynamik.  Stuttgart:  Teubner  Verlag.  1986. 


73 


[24]  ACSL-Advanced  Continuous  Simulation  Language  Reference  Manual.  Inc.  Con¬ 
cord/Mass.:  Mitchell  u.  Gauthier  Assoc..  1987. 

[25]  Otter,  M.;  Gaus,  N.:  .ANDECS-DSSIM;  Modular  Dynamic  Simulation  With 
Database  Integration.  User’s  Guide.  Version  2.1.  OberpfafFenhofen:  DLR. 

TR  R50-91,  1991. 

[26]  Leister,  G.:  Beschreibung  und  Simulation  von  Mehrkorpersystemen  mit  ge- 
schlossenen  kinematischen  Schleifen.  Fortschr.-Ber.  der  VDI-Zeitschriften.  Reihe 
11,  Nr.  167.  Dusseldorf:  VDI-Verlag,  1992. 

[27]  Blajer,  W.;  Contribution  to  the  projection  method  of  obtaining  equations  of 
motion,  Mechanics  Research  Communications  18,  pp.  293-301,  1991 

[28]  Baumgarte,  J.:  Stabilization  of  constraints  and  integrals  of  motion  in  dynamical 
systems,  Computational  Methods  in  Applied  Mechanics  and  Engineering,  1. 
pp.  1-16,  1972. 

[29]  Ostermeyer,  G.-P.:  On  Baumgarte  stabilization  for  differential  algebraic  equa¬ 
tions.  In:  Real-Time  Integraion  Methods  for  Mechanical  System  Simulation, 
NATO  ASI  Series,  Vol.  F69,  Berlin-Heidelberg:  Springer- Verlag  1990,  pp.l93- 
207. 

[30]  Woernle,  C.:  Ein  systematisches  Verfahren  zvr  Aufstellung  der  geometrischen 
Schliefibegingungen  in  kinematischen  Schleifen  mit  Anwendung  bei  der  Ruck- 
wartstransformation  fur  Industrieroboter,  Dusseldorf:  VDI-Verlag,  1988. 

[31]  Eppinger,  M.:  Kreuzer,  E.:  Evcduation  of  methods  for  solving  the  inverse  kine¬ 
matics  of  manipulators.  In:  Proc.  of  the  8-th  CISM-IFToMM  Symp.  on  Theory 
and  Practice  on  Robots  and  Manipulators,  Cracow.  1990. 

[32]  Blajer,  W.;  Schiehlen,  W.;  Schirm,  W.:  Dynamic  analysis  of  constrained  multi¬ 
body  systems  using  inverse  kinematics.  Mechanism  and  Maschine.  28(3), 

pp.  397-405,  1993. 

[33]  Schiehlen,  W.;  Blajer,  W.:  Closing  conditions  and  reaction  forces  of  multibody 
systems.  Zeitschrift  fur  Angewandte  Mathematik  und  Mechanik  (ZAMM),  72. 
pp.  T45-T47,  1992. 

[34]  Schiehlen,  W.:  Computational  aspects  in  muftibody  system  dynamics.  Compu¬ 
ter  Methods  in  Applied  Mechanics  and  Engineering,  30.  pp.  569-582.  1991. 


74 


ON-LINE  DYNAMIC  ANALYSIS  OF  MECHANICAL  SYSTEMS 


Thomas  R.  Kane 

Professor  of  Applied  Mechanics 

Stanford  University 

Stanford,  CA  94305 

USA 


ABSTRACT.  By  working  with  a  symbol  manipulation  computer  program  created 
specifically  for  this  purpose,  a  dynamicist  can  use  a  persons  computer  to  analyze 
motions  of  mechanical  systems  in  a  highly  efficient  manner.  The  theory  underh/ing 
the  computer  program  is  discussed,  and  illustrative  exeimples  are  presented. 


1.  Introduction 


The  behavior  of  a  mechanical  system  possessing  a  finite  number  of  d^rees  of 
freedom  is  governed,  in  general,  by  a  set  of  coupled,  nonlinear,  ordinary  differential 
equations.  Since  solutions  of  such  equations  only  rarely  can  be  found  in  closed  form, 
it  was  a  rather  thankless  task  to  formulate  such  equations  prior  to  the  advent  of 
computers.  Not  surprisingly,  the  subject  of  equation  formulation  methodolog}'  thus 
received  scant  attention  until  computers  made  it  possible  to  obtain  with  little  effort 
numerical  solutions  of  nonlinear  differential  equations;  and  then  it  became  apparent 
that  the  tMk  of  formulating  equations  of  motion  could  become  very  burdensome, 
especially  in  connection  with  many  problems  of  practical  interest.  To  overcome  this 
difficulty,  dynamicists  began  to  create  computer  programs  that  could  formulate 
equations  of  motion,  as  well  as  solve  them  numerically;  and  many  such  “multibody 
programs”,  as  they  have  come  to  be  called,  are  widely  used  today. 

Powerful  and  useful  as  they  may  be,  all  multibody  programs  suffer  to  varying 
degrees  from  one  major  defect,  which  is  that  they  impose  restrictions  on  the  way  a 
system  is  modeled  mathematically.  Most  notably,  the  dependent  variables  employed 
tend  to  be  fixed  once  and  for  all,  which  means  that  they  can  be  quite  unsuitable 
in  some  situations,  leading  to  computationally  inefficient  solutions.  Additionally,  the 
class  of  systems  accommodated  by  a  given  multibody  program  usually  is  quite  limited. 
For  ex2imple,  only  systems  with  a  certain  topology  may  be  analyzable,  say  a  tree- 
structure;  or  Coulomb  friction  forces  may  be  inadmissible,  etc.  To  say  it  simply,  the 
analyst  resorting  to  the  use  of  a  multibody  program  frequently  sacrifices  freedom  for 
convenience. 


A  relatively  recent  development  in  the  field  of  computing  makes  it  possil>le  at 
present  to  formulate  equations  of  motion  with  the  aid  of  a  computer  while  retaining 
all  of  the  freedom  enjoyed  by  an  cinalyst  deriving  equations  of  motion  "by  hand  ‘ 
This  development  is  the  creation  of  symbol  manipulation  languages  and  their  incor¬ 
poration  in  programs  specifically  designed  for  dynamic  analysis.  With  the  aid  of  such 
a  program,  one  can  perform  analytical  work  with  a  personal  computer,  doing  so  in  an 
interactive  fashion,  that  is.  by  typing  a  command  that  causes  the  computer  to  per¬ 
form  an  analytical  task  and  to  report  the  result  almost  instantaneously,  whereupon 
one  issuer  the  next  command,  and  so  on.  It  is  the  purpose  of  this  paper  to  describe 
this  process  in  detail,  to  explore  the  rationale  underlying  the  process,  to  discuss  a 
number  of  related  issues,  and  to  present  some  illustrative  examples. 

The  sequel  is  arranged  as  follows.  Section  2  detils  with  on-line  mathematical 
analyses  not  involving  any  mechanics-related  commands.  In  Sec.  3,  problems  of 
kinematics  are  addressed.  Inertia  calculations  are  the  subject  of  Sec.  4,  and  issues 
that  arise  when  one  attempts  to  employ  a  symbol  manipulator  to  formulate  equations 
of  motion  are  explored  in  Sec.  5.  The  on-line  determination  of  forces  is  considered  in 
Sec.  6.  and  concluding  remarks  appear  in  Sec.  7. 


2.  On-line  Symbolic  Mathematics 


Computer  programs  capable  of  carrying  out  symbolic  manipulations  have  existed 
for  a  long  time,  and  have  been  used  to  perform  tasks  such  as,  for  example,  expanding 
{A+  B  +  Cy  to  obtain 

A’  -f  +  C''  +  7{AB^  +  AC^-¥BA^  +  BC^  +  CA^  +  CB^) 

+  21{A^B^  -1-  A^C^  +  A^B^  +  -!■  B^C"  +  B^C^) 

+  35{A^B*  +  A^C*  -f  A*B^  -1-  A*C^  -f  B^C*  +  B*C^) 

-f  A2{ABC^  -1-  ACB^  -f  BCA^)  -I-  m(AB^C*  -f  AB^C^ 

-f  BA^C-*  -1-  BA*C^  -f  CA^B'^  -f  CA*B^)  -f  140(/1B^C^ 

-b  BA^C^  -f  CA^B^)  -b  210{A^B^C^  +  A^B^C^  -b  A^B^C^) 

Originally,  this  necessitated  creating  a  program  and  then  executing  it  on  a  mainframe 
computer,  but  more  recently  it  has  become  possible  to  type  an  instruction  such  as, 
for  example. 


EXPAND((.UB+C)"7) 

on  a  personal  computer  and  then  see  the  result  displayed  on  the  computer  screen 
within  a  short  time  after  pressing  the  ENTER  key.  To  illustrate  some  capabilities 
of  a  particular  program  of  this  kind,  called  AUTOLEV,  let  us  consider  a  number  of 
specific  examples. 

Suppose  that  F\  and  Fz,  the  first  a  function  of  x,  the  second  a  function  of  .c  and 
y,  are  given  by 

Fi  =Zx  —  5cos(i),  F2  =  e**' 

and  we  need  the  derivative  of  Fi  with  respect  to  x  and  the  partial  derivative  of  F2 
with  respect  to  y.  Activation  of  AUTOLEV  causes  the  line  number  (1)  to  appear  on 
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the  screen,  whereupon  one  types  VARIABLES  X,Y.  so  that  the  screen  now  appears  as 
follows; 


rp 

fe 

I 


s.' 


I ' 
? 

»? 


(1)  VARIABLES  X.Y 

(2) 

Next,  typing  FI  =  3*X-5*CQS(X)  and  pressing  ENTER  causes  .he  following  to  ap¬ 
pear  on  the  screen: 


(1)  VARIABLES  X.Y 

(2)  F1=3*X-5*C0S(X) 

»(3)  FI  =  3*X-5fC0S(X) 

Line  (3)  is  an  “echo''  of  the  assignment  statement  entered  in  line  (2).  No  such  echo 
was  produced  by  line  (1)  because  this  line  serves  as  a  declaration  rather  than  as  an 
assignment  statement.  Proceeding  similarly,  one  can  enter 

(4)  F2=EXP(X*Y) 

to  which  the  program  responds  with 

»(5)  F2  =  EXP(X*Y) 

and  now  the  desired  derivatives  are  found  by  typing 

(6)  DF1_DX«D(F1,X) 


which  produces 


while  entering 


leads  to 


»(7)  DF1_DX  =  3  5*SIN(X) 


(8)  DF2_DY=D(F2.Y) 


»(9)  DF2.DY  =  X*EXP(X*Y) 


The  left-hand  sides  of  lines  (6)  and  (8)  are  names  chosen  by  the  analyst,  whereas 
D(F1,X)  and  D(F2,Y)  are  instructions  issued  in  the  language  of  the  program. 

The  lines 
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(1)  CONSTANTS  A,B,C,D,E,F 

(2)  U='CA,B,C] 

»(3)  U  -  [A,  B.  C] 

(4)  V*[D;E;F3 
»(S)  V  -  CD,  E.  F] 

(6)  W”U*V 

cause  AUTOLEV  to  treat  U  and  V  as  a  1  x  3  row  matrix  and  a  3  x  I  column  matrix, 
respectively,  and  to  report  the  inner  product  of  U  and  V  as  the  1  x  1  matrix  VU  in 
line  (7): 

»(7)  W  =  [A*D  +  B*E  +  D*F3 
If  a  3  X  3  matrix  R  is  introduced  as 

(8)  R  =  [A,B,C;D,B,L:F,A,D3 
»(9)  R  *  [A,  B,  C;  D,  B,  E;  F,  A,  D3 
then  the  inverse  of  iZ,  arbitrarily  called  S  by  the  user,  is  generated  in  response  to 

(10)  S  ■  INVERT (R) 

which  yields 

»(i?)  Sri.l]  »  -(A*E-B*D)/(B*D*(A-D/-B*F*(C-E)-A*(A*E-C*D)) 

*>'12)  SQ1.2.  -  (A*C-B*D)/(B*D*(A-D)-B*F*(C-E)-A*(A*E-C*D)) 

>  v33)  S,S3l  =  •iJ*(C-E)/(B*D*(A-D)-B*F*(C-E)-A*(A*E-C*D)) 

»(14)  SUi,!]  =  (D''2-E*F)/(B*D*(A-D)-B*F*(C-E)-A*(A*E-C*D)) 

»(15)  Sr2,2l  =  (A-J-C*?)/(B*D*(A-D)-B*F*(C-E)-A*(A*E-C*D)) 

»(16)  S[2,3J  =  -(A‘£-C*D)/(B*D*(A-D)-B*F*(C-E)-A*(A*E-C*D)) 

»(17)  SL3,l1  «  (A*D-B*F)/(B*Do(A  D)-B*F*(C-E)-A*(A*E- C*D)) 

»(18)  SL3,2.  =  -(A*2-B*F)/(B*D*(A-D)-B*F*(C-E)-A*(A*E-C*D)) 

»(19)  SL3.3]  *  B*(A-D)/(B*D*(A-D)-B*F*(C-E)-A*(A*E-C*D)) 

Representative  vector  operations,  sc  important  in  dynamics,  car  be  performed  by 
introducing  a  reference  frame,  say  N,  with  the  declaration 

(20)  FRAMES  N 

which  causes  AUTOLEV  to  regard  Nl>.  N2>,  and  N3>  as  a  right-handed  set  of  mu¬ 
tually  perpendicular  unit  vectors  normally  written  N],  Nj,  N3.  Hence,  vectors 
V  =  ANi  +  BN2  +  CN3  and  W  =  Z?Ni  +  EN2  +  FN3  can  be  entered  as 

(3)  V>*A*N1>+B*N2>+C*N3> 

»(4)  V>  =  A*N1>  +  B*N2>  +  C*N3> 

(5)  W>=D*N1>+E*N2>+F*N3> 

»(6)  W>  =  D*N1>  +  E*N2>  +  F*N3> 
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and  X.  the  cross-product  of  V  and  W.  is  then  found  by  typing 

(7)  X>=CR0SS(V>,W» 

which  produces 

»(8)  X>  =  (B*F-C*E)»N1>  +  (C*D-A*F)*N2>  +  (A*E-B*D)*N3> 

Furthermore,  since  operation.^  can  be  "nested",  the  scalar  triple  product  of  V.  W. 
and  X  is  obtained  as 

(9)  TRIPLE=DOT(V>,CFOSS(H>,X>)) 

»(10)  TRIPLE  =  A*(E*(A*E-B*D)+F*(A*F-C»D)) 

-  C*(D*(A»F-C*D)+E*(B*F-C»E)) 

-  B*(D*(A*E-B'>D)-F*(B*F-C*E)) 

•As  a  final  illustration  in  the  use  of  AUTOLEV  for  purely  mathematical  purposes, 
we  consider  the  program’s  ability  to  simplify  expressions  such  as,  for  example. 

(cos( A)  -f  5  cos^( A)  +  6  cos^( A)  tan^( A)j/  cos( A) 

Simplification  is  accomplished  by  typing 

( 11 )  (COS (A) +5*C0S (A) *3+6*C0S (A) "3*TAN(A) *2) /COS (A) 
and  pressing  ENTER,  which  produces 

RESU1.T:  6  +  SIN  (A)  "2 


3.  On-Line  Kinematic  Analysis 


Certain  problems  of  kinematics  can  be  solved  on-line  simply  by  using  the  meth¬ 
ods  of  analytic  geometry.  For  example.  Fig.  1  shows  a  manipulator  formed  by  pin- 
connected  elements  A,  B,  C,  and  D.  The  lengths  ij,  12,  and  X3  of  A,  5.  and  C. 
respectively,  are  presumed  to  be  variable,  whereas  LD,  the  length  of  D  is  fixed.  D 
represents  a  load-carding  platform,  and  the  system  may  be  regarded  as  driven  either 
by  motors  at  points  G,  H,  and  I,  which  can  cause  the  angles  QA,  QB.  and  QC  to 
take  on  desired  values,  or  by  rack-and-pinion  drives  that  cause  the  lengths  of  A.  B. 
and  C  to  acquire  cissigned  values. 

For  given  values  of  the  angles  QA,  QB,  QC  and  the  lengths  LD.  LE.  LF.  it  is 
a  relatively  simple  matter  to  find  i],  X2.  and  X3,  for  this  can  be  accomplished  by 
solving  a  set  of  linear  equations.  By  way  of  contrast,  to  deal  with  what  is  sometimes 
called  the  “inverse  kinematics”  of  the  system,  that  is.  to  determine  the  values  of  QA. 
QB,  QC.  and  QD  corresponding  to  given  values  of  xi,  X2, 2:3,  LD.  LE,  and  LF.  one 
must  solve  a  set  of  coupled,  nonlinear  equations,  namely, 

xi  cos(QA)  +  LD  cos(QD)  ~  X2  cos{QB)  —  LF  =  0 
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Xj  sin((5^)  +  LD  sin{QD)  —  xj  sin((?B)  =  0 
X2  cqs(QB)  -  X3Cos((3C)  -  LE  =  0 
X2  sin((3fi1  -  X3  sm(QC)  =  0 

To  this  end.  one  can  execute  the  AUTOLEV  program 

VARIABLES  QA.QB.QC.QD 
CONSTANTS  X1,X2,X3,LD,LE,LF 
Z [1] =X1*C0S (QA)+LD*C0S (QD) -X2*C0S (QB) -LF 
Z  ,2  =X1*SIN(QA)+LD*SIN(QD)-X2*SIN(QB) 

Z  .3,  -X2#C0S(QB)-X3*C0S<QC)-LE 
Z[4J»X2*SIN(QB)-X3*SIN(QC) 

NONLINEARCZ .QA.QB.QC.QD) 

which  causes  AUTOLEV  to  create  a  FORTRAN  program  called  NONLIN.FOR  and 
to  prompt  one  to  enter  in  a  file  called  NONLIN.IN  the  values  of  the  given  quantities, 
as  well  as  guesses  for  the  values  of  QA,  QB,  QC,  and  QD.  Execution  of  the  program 
.NONLIN.FOR  then  produces  QA,  QB,  QC,  QD.  For  example,  for  xj  =  3.1  m, 
X2  =  3.5  m,  X3  =  5.1  m,  LD  =  4.0  m,  LE  =  4.3  m,  LF  =  4.4  m,  one  obtains 
QA  -  71.50  deg,  QB  =  80.96  deg,  QC  =  137.3  deg,  QD  =  74.21  deg. 

Vector  analysis  comes  into  play  in  dynamics  in  connection  with  angular  velocities 
and  angular  accelerations  of  rigid  bodies  and  velocities  and  accelerations  of  points. 
A  device  represented  schematically  by  Fig.  2  can  serve  as  a  case  in  point.  It  consists 
of  a  rigid  body  A  that  rotates  in  a  reference  frame  N  with  a  constant  angular  speed 
HT  about  an  axis  that  is  fixed  in  A  and  N  parallel  to  a  unit  vector  A1  and  that 
supports  an  arm  B  which  rotates  relative  to  A  with  a  constant  angular  speed  W2 
about  an  axis  fixed  in  A  and  B  and  parallel  to  a  unit  vector  A2.  The  magnitude 
of  the  acceleration  of  point  D  in  iV  is  to  be  expressed  in  terms  of  Wl,  W2,  LI  and 
L2  for  an  instant  at  which  the  angle  E  in  Fig.  2  is  equal  to  90  deg.  An  AUTOLEV 
solution  of  this  problem  begins  with  the  declarations 

CONSTANTS  H1,H2,L1,L2 
FRAMES  N.A.B 
POINTS  C.D 

Next,  the  velocity  of  C  in  N,  the  angular  velocity  of  A  in  N,  the  angular  velocity  of 
B  in  N,  and  the  position  vector  from  C  to  £>  are  entered  by  inspection  as 

V_C.N>»-L1*W1*A3> 

W.A_N>«H1*A1> 

W_B.N>»H_A_N>-H2*A3> 

P_C_D>=L2*A1> 


Corresponding  equations  can  be  produced  equedly  easily  by  hand.  But  the  next 
command. 


creates  an  expression  for  the  angular  acceleration,  of  B  in  N  by  employing  the  pro¬ 
gram's  ability  to  differentiate  vectors  in  a  specified  reference  frame,  and  this  saves  a 
considerable  amount  of  hand  labor.  Moreover,  once  this  line  has  been  executed,  sig¬ 
nificant  savings  in  time  and  effort  are  realized  when  an  expression  for  the  acceleration 
of  point  D  in  N  is  created  in  response  to  the  command 

A2PTS(N,B.C,D) 

This  command,  based  on  a  familiar  kinematical  theorem,  instructs  AUTOLEV  to  find 
the  acceleration  of  C  in  N  by  differentiating  the  velocity  of  C  in  iV  with  respect  to  t 
in  N  and  then  adding  to  the  resulting  vector  the  vector  produced  with  the  command 

CROSS ( ALF_B_N> , P.C_D>) +CR0SS (W_B_N> , CROSS (W_B_N> , P_C_D> ) ) 
AUTOLEV  calls  the  result  A_D.N>,  sc  that  all  that  remains  to  be  done  is  to  type 

MAGNITUDE=MAG ( A_D_N> ) 


which  yields 

»(17)  MAGNITUDE  =  (L1"2*W1'4+L2*2*W2‘4+4*L2“2*H1*2*W2*2)*0.5 

This  example  shows  that  the  symbol  mtmipulato;  under  consideration  “knows”  certain 
kinematical  theorems.  In  fact,  it  contains  many  coaimands  based  on  theorems  d<;aling 
with  orientation  angles.  Euler  parameters,  directin’'  cosines,  etc. 


4.  On-Line  Inertia  Calculations 


Figure  3  shows  a  solid,  right-circular  cone  C  of  radius  R  and  height  H.  as  well  as 
rnutually  perpendicular  unit  vectors  Cl,  C2,  C3.  The  moment  of  inertia  of  C  about 
line  A  —  B,  to  be  denoted  by  lAB,  is  to  be  expressed  in  term  of  R,  H,  and  the  mass 
M  of  C,  in  terms  of  which  II,  12,  73,  the  central  moments  of  inertia  of  C,  are  given 
by 

71  =  73  =  3M(47?^  +  77*),  72  =■  3M7i*/10 
We  begin  the  analysis  with  the  declarations 


CONSTANTS  R,H 
BODIES  C 
MASS  C,H 
POINTS  A,B 


and  enter  71  and  72  as 


I1=3*M*(4*R‘2+H“2) 

I2=3*M*R'2/10 


The  central  inertia  dyadic  of  C  is  created  with  the  line 
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INERTIA  C, II, 12, II, 0,0,0 


and  the  position  vector  from  C,  the  mass  center  ot  C.  to  point  .*1.  by  typing 
P_CSTAR_A>=0 . 75*H*C2> 

The  command 

PARALLEL (C, A) 

thereupon  causes  AUTOLEV  to  construct  the  inertia  dyadic  of  C  for  point  A,  which 
brings  us  into  position  to  find  lAB  by  pre-  and  post-multiplying  this  dyadic  with  a 
unit  vector  parallel  io  A  —  B.  This  unit  vector,  which  we  call  AB>.  is  formed  with  the 
line 

AB>*UNITVEC (R#C1>-H*C2> ) 

All  that  remains  to  be  done,  therefore,  is  to  issue  the  command 
IAB«EXPAND(DOT(AB> ,D0T(I_C_A» , AB>) ) 

which  produces 

18)  lAB  =  3.8625*K*R"2*(H‘2+3.1067961*R*2)/(H*2+R‘2) 

Should  it  be  necessary  to  eveiluate  lAB  for  particular  values  of  A/,  R,  and  H,  say 
M  =  1,  i?  =  2,  Af  =  3,  this  is  accomplished  with  the  additional  line 

IABVALUE=EVALUATE(IAB ,H=1 ,R=2 ,H=3) 

which  leads  to  the  response 

»(20)  lABVALUE  =  25.465385 

This  example  shows  that  AUTOLEV  incorporates  certain  fundamental  theorems  as¬ 
sociated  with  inertia  concepts. 


5.  On-Line  Formulation  of  Dynamical  Equations  of  Motion 


Dynamical  equations  of  motion  are  created  by  expressing  dynamical  principles  or 
form^sms,  such  as  Newton’s  laws,  the  angular  momentum  principle,  ot  Lagrange's 
equations,  in  terms  of  quantities  characterizing  the  physical  properties  and  behavior 
of  a  material  system.  Clearly,  some  of  the  on-line  analysis  capabilities  already  dis¬ 
cussed  can  be  used  for  this  purpose;  but,  as  we  shall  see.  on-line  equation  of  motion 
formulation  cem  be  performs  most  effectively  only  when  certain  issues  specific  to  this 
process  have  been  resolved  optimally. 


85 


Suppose  that  an  analysis  of  rocket  flight  is  to  be  undertaken  by  reference  to  the 
simple,  planar  model  suggested  by  Fig.  4,  where  q;  (t  =  1,2,3)  play  the  roles  of 
generalized  coordinates  in  the  sense  of  Lagrange,  while  the  set  of  all  contact  and 
distance  forces  acting  on  the  rocket  A  is  represented  by  the  measure  number  TC  of 
the  torque  of  a  couple  and  the  measure  numbers  Pj  and  P2  of  a  force  applied  at  A". 
the  mass  center  of  A.  To  formulate  dynamical  equations  of  motion  with  the  aid  of 
Lagrange’s  method,  one  can  begin  by  introducing  v,  (:  =  1,2,3)  via  the  kinematical 
differential  equations 

dq,fdt-v,  (f=  1,2,3) 

Next,  after  expressing  the  kinetic  energy  K  of  A  as 

K  =  \[M{v]  +  q]vl)  +  l(y2  +  us)^) 
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and  the  generalized  forces  F,  {i  =  1.2.3)  as 

Fi  =  Pi  cos(93)  -  Pjsinf^a) 

F2  =  9i(Pi  sin(93)  +  P2COs(93)]  +  TC 

F^  =  TC 

one  substitutes  into  Lagrange’s  equations.  This  necessitates  various  differentiations 
of  K .  which  can  be  performed  conveniently  with  a  symbol  manipulation  computer 
program.  For  example,  employing  AUTOLEV,  we  enter  the  lines 


CONSTANTS 

VARIABLES  QC3]  ,VC3]  .P[2]  ,TC  ^  ^ 

K*0 . 5* (M* (VI “2+Ql “2*V2*2) +1* (V2+V3) *  2) 
Fl»PlfCQS(Q3)-P2*SIN(Q3) 
F2*Q1*(P1*SIN(Q3)+P2*C0S(Q3))+TC 
F3*TC 


Q1’=V1 

Q2'=V2 

q3’=V3 


and  then  create  the  dynamical  equations  of  motion  with  the  commands 


*EXPAND(DT(D(K,V1))-D(K,Q1)-F1) 
_ .  . -EXPAND (DT (D (K . V2) ) -D (K . Q2) -F2) 
Z  [3]  -EXPAND  (DT  (D  (K ,  V3)  )  -D  (K ,  Q3)  -F3) 


The  resulting  equations  are 

M{dvildt  —  qiv\)  =  Pi  003(93)  -  P2  sin(g3) 

(/  +  Mq\)dv2ldt  +  Idvzjdt  +  2MqiViV2  =  9i[Pi  sin(93)  —  P2  cos(93))  —  TC 
l{dv2ldt  +  dvzjdt)  —  TC 

The  relative  complexity  of  these  equations  is  attributable  to  the  fact  that  v,-  (e  = 
1.2,3)  are  poor  variables  for  dealing  with  the  problem  at  hand.  To  see  this,  let  us 
examine  what  happens  when  one  uses  as  dependent  vtiriables,  in  addition  to  91,  qi, 
and  93,  generalized  speeds  ui,  U2,  and  U3  defined  as  follows:  ui  and  are  the  measure 
numbers  of  the  social  and  transverse  components  of  the  inertial  velocity  of  the  mass 
center  of  A,  and  U3  is  an  inertial  angular  speed  of  A.  This  leads  to  the  kinematical 
differential  equations 

dqildt  =  Ui  003(93)  -  U2sin(93) 
dq2/dt  =  (ui  sin(93)  +  U2  cos(93)l/9i 
dqs/dt  =  U3  -  [ui  sin(93)  +  U2  cos(93)]/9i 

Sind,  resorting  to  the  use  of  Newton-Euler  methods  'oy  summing  forces  in  the  axial 
and  transverse  directions,  one  obtains  the  two  dynamical  equations 


M{duildt  —  U2U3)  =  Pi 


M{dxi2ldt  +  U3U1)  =  P2 


"riiie  taking  moments  about  the  mass  center  of  A  yields  the  remaining  dynanucal 
eouauon. 

Idu^/dt  =  TC 

Obviously,  these  equations  are  significantly  simpler  than  tneir  earlier  counterparts. 
The  reason  we  used  Newton-Euler  methods,  rather  than  Lagrange’s  equations,  to 
formulate  them  is  that  the  latter  are  inapplicable  in  their  usual  form  under  the  present 
circumstances,  that  is,  when  the  kinetic  energy  is  regarded  as  a  function  of  and  ' 
ir  =  1.2.3),  rather  than  as  a  function  of  qr  and  dq^/dt  (r  =  1,2,3).  For  this  reasi 
alone  it  is  inadvisable  to  base  a  computer  program  intended  to  facilitate  equation 
of  motion  formulation  on  Lagrange’s  equations.  An  additioncJ  fact  that  mitigates 
against  the  use  of  Lagrange’s  equations  is  that  such  use  frequently  necessitates  the 
performing  of  operations  leading  to  terms  that  ultimately  cancel  each  other  or,  if  they 
do  not.  give  rise  to  computations  that  have  no  effect  on  final  results.  For  purposes 
of  computerized  symbol  manipulation,  this  is  an  important  consideration,  for  it  has 
serious  implications  regrirding  computer  memory  usage. 

WTiat  about  Newton-Euler  methods?  Does  the  fact  that  they  serve  well  in  con¬ 
nection  with  the  rocket-flight  example  justify  the  inference  that,  in  general,  they 
constitute  a  sound  basis  for  computerized  equation  of  motion  formulation?  It  be¬ 
comes  apparent  that  this  is  not  the  case  when  one  attempts  to  formulate  equations 
of  motion  for  a  system  such  as,  for  example,  the  one  depicted  in  Fig.  1,  that  is.  one 
containing  “loops.”  Under  these  circumstances,  the  use  of  Newton-Euler  methods 
for  the  formulation  of  equations  of  motion  necessarily  entails  the  introduction  and 
subsequent  elimination  of  certain  constraint  forces,  processes  which  are  sufficiently 
algcnthmically  subtle  and  computationally  intensive  to  give  rise  to  significant  obsta¬ 
cles  to  the  creation  of  an  efficient  on-line  equation  of  motion  formulation  program. 

As  is  explained  in  detail  in  [1],  the  equations 

Fr-f-F;r  =  0  (r=l,...,p) 

furnish  an  alternative  to  Lagrange’s  equations  and  Newton-Euler  methods  as  a  point 
of  departure  for  the  formu'ation  of  dynamical  equations  of  motion  of  any  mechanical 
system  possessing  p  degrees  of  freedom.  Given  such  a  system,  one  begins  the  equation 
formulation  process  by  performing  a  “first  level”  kinematic  analysis,  that  is,  by  con¬ 
structing  expressions  for  angular  velocities  of  rigid  bodies,  velocities  of  mass  centers 
of  these  bodies,  and  velocities  of  particles.  Next,  one  creates  vectors  representii^ 
active  forces  and  torques,  which  brings  one  into  position  to  form  expressions  for  iv 
cind  F*  by  ctirrying  out  operations  that  can  be  programmed  once  and  for  tdl.  This  is 
the  rationale  underlying  the  program  AUTOLEV.  As  a  first  illustrative  example,  we 
return  to  the  rocket  problem  represented  by  Fig.  4. 

The  statement 


NEWTONIAN  N 

serves  to  inform  the  program  that  a  reference  frame  called  jV  is  to  be  regarded  as 
Newtonian,  that  is,  as  one  such  that  use  of 

Fr-1-F;  =  0  (r=l,...,p) 

leads  to  physically  correct  results.  Next,  the  lines 
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VARIABLES  U1 ,U2,U3,Q1.Q2,Q3 


declare  Ur  and  {r  =  ]  '’.3)  as  time-dependent  variables  to  be  employed  to  char¬ 
acterize  the  motion  and  configuration  of  the  rocket,  whose  mass  and  relevant  inertia 
properties  are  brought  into  the  program  with  the  statements 

BODIES  A 
MASS  A,M 

I_A_ASTAR=I*A3*A3 

The  afore»,,3ntioned  first  level  kinematic  analysis  is  carried  out  simply  by  expressing 
the  velocity  of  the  mass  center  of  ^4  in  as 

V_ASTAR_N>=U1*A1>+U2*A2> 


and  the  angular  velocity  of  A  in  N  as 

W,A.N>»U3*A3> 


Forces  and  torques  are  entered  with  the  lines 

ACTIONS  F1,F2,T0R 

F0RCE(ASTAR,F1*A1>+F2*A2>) 

T0RqUE(A,T0R*A3>) 


The  rest  is  accomplished  by  typing 


ZERO=FR()+FRSTAR() 

UNCOUPLEO 


This  yields  the  dynamical  equations  of  motion  by  evoking  the  response 

»(20)  Ul'  =  U2*U3  +  Fl/M 
»(21)  U2'  =  F2/M  -  U1*U3 
»(22)  U3'  =  TOR/I 

The  four-bcir  linkage  shown  in  Fig.  5  provides  a  second  illustrative  example,  one 
involving  a  loop.  A,  B,  and  C  are  massless  rods  of  length  LA,  LB,  and  LC,  respec¬ 
tively;  tne  revolute  joints  supporting  A  and  C  at  P  and  0  have  vertical  axes  and 
are  separated  by  a  distance  LD;  PAB  and  PBC  designate  particles  of  mass  M;  and 
Qa,  QB,  and  QC  are  the  angles  between  line  0  -  P  and  A,  B,  and  C,  respectively. 
Finally,  a  couple  whose  torque  is  indicated  in  Fig.  5  is  applied  to  C.  The  objective 
of  the  analysis  to  be  undertaken  is  to  produce  motion  simulations,  that  is,  plots  of, 
say,  QC  as  a  function  of  time  t. 

As  before,  we  begin  with 


NEWTONIAN  N 
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Figure  5:  Four-bar  Linkage 
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\.:houeh  the  system  under  consideration  possesses  only  one  degree  of  freedom,  it 
^  ''xcedieut  (and  permissible)  to  introduce  three  generalized  speeds.  Therefore,  we 
cominue  by  entering 


VARIABLES  U1,U2,U3,QA,QB,QC 
CONSTANTS  U.LB.LC.LD 
PARTICLES  PAB.PBC 
MASS  PAB.M,PBC,M 
POINTS  PCO 

The  last  line  introduces  a  point  named  PCO,  intended  to  be  the  point  of  C  in  contact 
with  0. 

Kinematical  differential  equations  are  created  by  typing 


QA'=U1 

QB’=U2 

qC'=U3 


and  the  angles  QA,  QB,  QC  are  brought  into  the  analysis  with  lines 


FRAMES  A,B,C 
SIMPR0T(N,A,3,QA) 
SIMPR0T(N,B,3,QB) 
SIMPR0T(N,C,3,qC) 


which  have  the  effect  of  creating  direction  cosine  matrices  relating  unit  vectors  vari¬ 
ously  fixed  in  A,  B,  and  C  to  unit  vectors  N,  (f  =  1,2,3)  fixed  in  N.  The  direction 
cosine  matrices  relating  the  unit  vectors  variously  fixed  in  A.  B,  and  C  to  each  other 
are  generated  with  the  commands 


A_B»A_N*N_B 

B_C=B_N*N_C 

C_A=C_N*N_A 


The  angular  velocities  of  A.  B,  and  C  in  N  and  the  velocities  of  PAB,  PBC,  and 
POC  in  N  are  entered  as 


W_A_N>=U1*A3> 

W_B_N>=U2*B3> 

W_C_N>=U3*C3> 


V_PAB_N>=LA»U1*A2> 

V_PSC.N^-V_PAB_N>-LB*U2*B2> 

V_PC0_N>=V_PBC.N>-LC*U3*C2> 


and  two  constraint  equations  are  produced  by  noting  that  the  velocity  of  POC  in  N 
must  vanish,  which  requirement  is  enforced  with  the  lines 


C0NSTRAIN[1]=D0T(V.PC0.N> ,N1>) 
C0NSTRAIN[2J=D0T(V_PC0.N> ,N2>) 

CONSTRAINO 

The  la^t  line  causes  the  program  to  solve  the  constraint  equations,  that  is,  to  express 
U2  and  t/3  in  terms  of  u\. 

The  couple  applied  to  C  is  brought  into  the  progrrim  with  lines  that  characterize 
the  torque  of  the  couple,  namely, 

CONSTANTS  TO, OMEGA 
T0RQUE(C,T0*SIN(0MEGA*T)*C3>) 

and  the  equations  of  motion  appear  in  response  to  the  command 

ZERO»FR()+FRSTAR() 

Finally,  to  cause  AUTOLEV  to  write  a  FORTRAN  program  for  the  numerical  solution 
of  the  equations  of  motion,  all  one  has  to  do  is  to  type 

CODE  LINKAGE 

To  verify  that  the  foregoing  on-line  operations  can  lead  directly  to  tangible  results, 
one  can  use  the  FORTRAN  program  LINKAGE.FOR  created  by  AUTOLEV  to  deter¬ 
mine  the  response  of  the  liallago  to  the  oscillatory  torque  appliM  to  C  if,  for  example, 
the  system  is  initially  at  rest  with  QA  =  90  deg,  QB  =  0,  QC  =  60  deg  and  LB  =  0.3 
m,  LC  =  0.5  m,  tn  =  0.6  rad/s,  and  To  =  0.8  Nm.  Figure  6  is  a  plot  of  QC  vs.  t 
based  on  numerical  results  obtdned  with  LINKAGE.FOR. 


6.  On*Line  Determination  of  Forces 


Fr^uently.  the  principal  purpose  of  a  dynamic  analysis  is  to  determine  forces, 
sometimes  cdled  constraint  forces,  that  come  into  play  during  the  motion  of  a  me¬ 
chanical  system.  The  motion  itself  may  be  known  a  priori,  or  it  may  have  to  be 
determined  simultaneously  with  the  unknown  forces.  In  either  case,  it  is  disadvan¬ 
tageous  to  employ  Lagrange’s  equations  when  these  provide  the  desired  information 
only  with  the  jug  pf  Lagrange  multipliers,  for  this  tends  to  complicate  an  analysis 
unnecessarily.  Similarly,  the  use  of  Newton- Euler  methods  can  necessitate  the  intro¬ 
duction  and  subsequent  elimination  of  quantities  not  of  interest  in  their  own  right.  By 
way  of  contrast,  the  equation  of  motion  formulation  methodology  discussed  in  Sec.  5 
and  underlpng  the  program  AUTOLEV  furnishes  the  meams  for  the  selective  deter¬ 
mination  of  scalar  unknowns  associated  with  unknown  forces.  Suppose,  for  example, 
that  it  is  desired  not  only  to  determine  the  motion  of  the  linkage  considered  in  the 
previous  section,  but  also  to  evaluate  for  each  instant  of  such  a  motion  the  magnitude 
of  the  force  exerted  on  C  by  the  bearing  at  point  0.  Only  minor  modifications  of  the 
earlier  program  are  required  to  obtain  the  desired  information.  Specificadly,  following 


ACTIONS  TOR 


the  line 


AUXACTIONS  F1,F2  \ 

\ 

is  added  to  introduce  two  scalars  that  will  presently  be  used  to  characterize  the  force  | 

in  question.  The  lines  dealing  with  constrciint  conditions  are  modified  to  read  j 

AUXC0NSTRAIN[1]»D0T(V.PC0_N> ,N1>) 

AUXCOMSTRAIN [2] =D0T(V_PC0_N> ,N2>) 

AUXCONSTRAINO  t 

and  the  force  applied  to  C7  at  0  is  accommodated  with  the  statement  | 

F0RCE(PCD ,F1*N1>+F2*N2>) 

A  new  FORTRAN  program  is  created  by  executing  the  new  AUTOLEV  program, 

and  this  brings  one  into  position  to  generate  the  desired  results.  For  instance,  using  i 

the  same  data  as  before,  one  obtains  the  the  force  vs.  t  plot  shown  in  Fig.  7. 


7.  Conclusion 


While  computers  have  plajred  a  major  role  in  the  solution  of  various  problem  of 
dynamics  for  many  years,  their  use  in  the  manner  described  in  this  paper  is  in  its  ; 

infancy.  Experience  gained  to  date  suggests  that  the  new  approach  can  be  highly 
effective  not  only  in  an  industrial  setting,  but  also  in  connection  with  the  teaching  of 
the  subject  of  dyneimics.  Because  a  good  symbol  manipulation  program  allows  one 
to  carry  out  quickly  and  effortlessly  many  analytical  tasks  which,  when  performed 
by  hemd.  are  both  arduous  and  time-consuming,  such  a  program  can  enable  one  to 
devote  more  time  and  energy  than  would  otherwise  be  available  to  the  study  of  the 
fundamental  concepts  underlying  a  given  analysis.  AdditioneJly,  it  is  a  simple  matter  ^ 

to  create  a  permanent,  easily  readable  record  of  an  on-line  anedysis,  which  can  be  of 
great  value  for  purposes  of  cnedcing  and  reviewing.  It  remains  to  be  seen  how  widely 
the  new  approach  will  be  adopted.  j 
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ABSTRACT.  To  exploit  the  benefits  of  parallel  computer  curchitec-  * 

tures  for  multibody  system  simulation  an  interdisciplinary  approach  has 

been  pursued,  combining  knowledge  of  the  three  disciplines  dynamics,  nu-  i 

merical  mathematics  and  computer  science.  An  analysis  of  the  options 
available  for  the  formulation  and  numerical  solution  of  the  dynamical  sy¬ 
stem  equations  yielded  a  surprising  result.  A  method,  initially  proposed  ^ 

to  solve  the  inverse  problem  of  dynamics,  is  the  best  choice  to  generate 
the  system  equations  required  for  solving  the  simulation  problem,  when 
relying  on  implicit  integration  routines.  Such  routines  have  the  particular 
advantage  of  handling  stiff  systems,  too.  The  new  0(N)  residual  forma¬ 
lism,  generating  the  system  equations  in  a  form  required  for  implicit  nu¬ 
merical  integration  has  a  high  potential  to  benefit  from  parallel  computer 
architectures.  Two  strategies  of  medium  and  coarse  grain  parallelization 
have  been  implemented  on  a  Transputer  network  to  obtain  a  package  for 
parallel  multibody  simulation.  An  analysis  of  the  performance  of  this 
package  demonstrates  for  typical  multibody  simulation  problems: 

□  The  new  code  is  five  times  faster  than  existing  codes  when  implemen¬ 
ted  on  a  serial  computer. 

□  An  additional  speed-up  by  the  same  order  of  magnitude  is  obtained,  • 

when  the  code  is  implemented  on  a  Transputer  network. 

□  The  relative  advantages  of  the  two  strategies  of  medium  and  coarse  ; 

grain  parallelization,  available  with  the  code,  depend  on  the  problem.  •  * 

In  particular,  the  simulation  program  does  not  ask  the  user  to  distribute  *! 

work  packages  in  the  network.  It  takes  care  of  such  problems  automati¬ 
cally  and  presents  itself  in  the  same  way  as  any  serial  code.  ; 


lUieqration,  matrix  inversion,  or  eigcnsystem  analysis,  and  lately  have  shifted  to  pre- 
•.•rocessors  and  postprocessors  for  user  convenience.  More  fundamental  issues  are 
.-.used  by  the  potential  of  symbolic  manipulation  and  parallel  processing,  both  of 
■.■■  hich  present  the  possibility  cf  revolutionizing  the  held.”  Concepts  r  symbolic  im- 
piementation  have  been  pursued  at  various  places,  e.g  [14,  21).  This  paper  presents 
results  of  our  efforts  to  exploit  the  potential  of  parallel  computer  architectures  for 
inultibody  simulation.  It  has  its  roots  in  an  analysis  of  the  status  oi  knowledge  at 
the  time,  the  above  statement  was  made. 

Basic  methods  for  multibody  system  simulation  are  provided  by  the  disciplines  of 
dynamics  (the  multibody  formalisms),  numerical  mathematics  (the  solution  techni¬ 
ques)  and  computer  science  (the  design  of  simulation  codes)  -  see  boxes  in  Fig.  1. 
In  the  mid-eighties  the  formalisms  for  the  generation  of  multibody  system  equati¬ 
ons  and  the  numerical  methods  for  solving  ordinary  differential  equations  had  been 
fully  developed,  but  the  interaction  between  the  related  areas  of  research  was  poor  in 
most  of  the  groups  working  on  the  development  of  multibody  codes.  The  so-called 
0(/V)-formalisms  had  been  found  at  various  places  independently  (23),  yielding  the 
state  space  representation  of  the  system  dynamics  in  explicit  form  with  a  number 
of  operations,  which  grows  linearly  with  the  number  N  of  system  bodies.  Solving 
the  equations  generated  in  such  a  way  with  numerical  integration  routines  at  hand 
was  considered  to  be  the  most  efficient  approach  to  multibody  system  simulation. 
Other  codes  were  based  on  the  description  of  the  system  dynamics  by  a  set  of  diffe¬ 
rential  equations  in  terms  of  redundant  variables  accompanied  by  a  set  of  algebraic 
constraint  equations,  i.e.  the  codes  generated  and  solved  the  Lagrangian  equations 
of  type  one.  To  improve  the  performance  of  such  codes,  the  numerical  solution  of 
differential-algebraic  equations  was  studied  by  an  increasing  number  of  mathemati¬ 
cians,  generally  without  considering  any  special  properties  of  the  multibody  system 
equations.  One  of  the  attempts  to  initialize  communication  between  dynamicists  and 
mathematicians  was  made  by  E.  J.  Haug  when  organizing  the  workshop  on  ’’Real- 
Time  Integration  Methods  for  Mechanical  System  Simulation”  in  1989  |8).  The  prime 
motivation  for  the  meeting  was  the  need  to  realize  multibody  real-time  simulation 
in  such  applications  as  general  purpose  car  simulators.  Additional  aspects  for  re¬ 
ducing  multibody  simulation  time  in  vehicle  dynamics,  industrial  applications  have 
been  described  in  (12),  e.g.  for  usage  in  hardware-in-the-loop-tests  of  ABS  and  ASC 
(anti-slip-control).  Design  procedures  for  control  systems  in  vehicles  and  spacecraft 
also  called  for  a  significant  reduction  of  simulation-time.  During  the  specialists  mee¬ 
ting  at  the  JPL  in  1987  the  simulation  requirements  in  control  system  design  were 
described  as  follows  (11):  "Problem  solutions  must  be  run  in  large  numbers  to  arrive 
at  design  decisions,  and  large  systems  must  be  studied.  Computational  speed  there¬ 
fore  becomes  the  most  important  single  consideration  in  code  design.”  This  necessity 
was  even  more  emphasized  at  a  conference  in  the  summer  of  1989  (18). 

Most  of  the  implementations  of  multibody  codes  were  on  serial  computers.  To  reduce 
computational  costs  the  usage  of  parallel  computation  was  discussed,  but  again  with- 


out  any  interdisciplinary  considerations.  In  [l]  the  most  advanced  option  of  those 
days,  the  0(AI)-formalism,  was  implemented  on  a  parallel  computer  yielding  little 
reduction  of  computer-time,  even  for  large  multibody  systems. 


Figure  1:  Areas  of  research  required  in  multibody  system  simulation. 


In  our  contribution  we  pursue  the  idea  of  how  to  combine  the  methods  available  in 
computer  science,  dynamics  and  numerical  mathematics  i..'  an  optimal  way  to  obtain 
the  most  efficient  solution  of  the  simulation  problem  -  in  other  words,  we  want  to 
exploit  the  potential  of  an  interdisciplinary  approach  to  the  problem  as  visualized  by 
the  arrows  in  Fig.  1.  The  goal  is  a  reduction  of  computer-time  beyond  the  limits 
described  in  the  references  mentioned  above.  This  goal  is  achieved  by  an  appro¬ 
priate  tuning  of  multibody  formalisms  and  numerical  solution  techniques  resulting 
in  a  formulation  of  the  simulation  problem,  which  has  a  high  potential  for  parallel 
computation.  Its  implementation  on  a  network  of  Transputers  yields  reductions  of 
simulation-time  considerably  higher  than  those  found  in  previous  approaches. 

2  Options  for  Solving  the  Problem 

In  view  of  Fig.  1  the  methodologies  available  from  the  branches  of  science  contributing 
to  multibody  simulation  are  discussed  now.  Two  forms  of  system  equations  may  be 
generated  by  methods  available  from  the  first  one  of  the  three  disciplines,  dynamics. 
The  two  forms  are  the  state  space  representation 


yi  =  yn  ,  (la) 

MR{yi,t)yii  =  hR(yi,yn,t)  ,  (lb) 

and  the  descriptor  form  (Lagrangian  equations  of  type  one) 

±1-  XII  =  0  ,  (2a) 

M{xi,t)xii-G^  {xi,t)X-  h{xi,xii,t)  =  0,  (2b) 

g(xi,i)  =  0.  (2c) 


Equations  (1)  are  formulated  in  terms  of  the  (independent)  position-  and  velocity- 
state-variables  yi  and  yij,  whereas  the  coordinates -i/  and  the  velocities  xu  in  (2)  are 
redundant.  Therefore,  generalized  constraint  forces  A  appear  in  (2b)  and  the  diffe¬ 
rential  equations  (2a,  2b)  are  accompanied  by  a  set  of  algebraic  constraint  equations 
(2c).  Collecting  coordinates  yj  and  velocities  yu  in  the  state  vector  y,  the  two  sets 
of  equations  (1)  can  be  compacted  into  the  explicit  system  of  ordinary  differential 
equations  (ODE) 

y  =  /(y.O.  (3) 

after  the  reduced  mass  matrix  Mr  has  been  inverted.  Similarly,  defining  x  to  contain 
xijXji  and  A,  the  set  of  equations  (2)  can  be  abbreviated  as 

F{x,x.t)  =  0,  (4) 

yielding  an  implicit  system  of  differential-algebraic  equations  (DAE). 

A  survey  of  methodologies  in  multibody  dynamics  shows,  that  the  generation  of 
the  state  space  representation  is  straightforward  only  in  the  case  of  tree-configured 
systems,  when  using  relative  variables  to  represent  the  system  motion.  An  application 
of  the  corresponding  method  to  generate  the  equations  of  motion  for  systems  with 
closed  kinematic  chains  yields  a  set  of  partially  reduced  system  equations  in  terms  of 
redundant  variables,  i.e.  a  system  representation  of  the  general  form  (2).  This  is  a  first 
option  when  dealing  with  generJ  multibody  systems  including  closed  loops.  A  second 
choice  is  to  use  absolute  variables.  Then  the  descriptor  form  (2)  of  the  equations  of 
motion  can  be  obtained  with  very  low  effort.  A  third  alternative  is  provided  by 
the  recursive  0(fV)-formulations.  In  case  of  tree-configured  systems  they  yield  the 
explicit  form  (3)  in  terms  of  relative  variables  with  a  number  of  operations,  which 
grows  linearly  with  the  number  N  of  system  bodies.  In  case  of  systems  with  closed 
loops  a  so-called  semi-explicit  form  [24)  in  terms  of  redundant  relative  variables  can 
be  obtained. 

Numerical  methods  for  solving  the  explicit  equations  are  well  developed.  Such  ’’ex¬ 
plicit  integration  routines”  for  ODE  require  the  evaluation  of  the  right  hand  side  of 

(3) 

fm  —  /  (l/mytm)  (5) 

given  the  state  ym  at  time  These  computations  must  be  provided  based  on  the 
multibody  formalism.  Unfortunately,  explicit  integrators  break  down  in  case  of  stiff 
systems.  But  these  appear  quite  often  in  multibody  simulation,  e.g.  when  dealing 
with  contact  or  control  problems  and  with  flexible  bodies.  This  is  why  the  usage  of 
explicit  integrators  and  of  the  corresponding  form  of  the  system  equations  as  provided 
by  the  0(A^)-formulations  is  excluded  here. 

For  tiie  numerical  solution  of  the  implicit  equations  (2)  or  (4)  two  approaches  have 
been  proposed.  One  possibility,  the  "coordinate  partitioning  method”  [7],  corresponds 
to  a  numerical  reduction  to  the  state  space  form  (1).  An  improvement  of  this  method 
has  been  proposed  in  (15).  The  second  option,  to  be  pursued  here,  is  to  use  implicit 


iriiikistep  methods  as  implemented  in  the  code  DASSL  (19).  Applications  of  the  code 
solve  mechanical  system  equations  resulted  in  stability  problems.  They  triggered 
i  he  development  of  the  derivative  ODASSL  (4)  of  DASSL.  which  avoids  such  instabi¬ 
lities.  By  contrast  with  explicit  integration  routines  for  ODE  the  implicit  ir.ultistep 
methods  for  solving  the  DAE  (4)  require  the  computation  of  the  residual 

(^) 

given  approximations  for  the  variables  x,„  and  the  derivatives  im  together  with  time 
tm-  The  residual  Am  is  nonzero  as  long  as  the  approximations  do  not  satisfy  (4). 
Integration  routines  like  ODASSL  use  values  of  Am  0  to  compute  the  solution  of 
(4),  corresponding  to  Am  =  0. 

.A  simple  consequence  of  the  interaction  between  numerical  mathematics  and  dyna¬ 
mics  in  multibody  simulation  has  been  mentioned  already:  explicit  integrators  fail 
for  stiff  systems,  which  suggests  to  avoid  the  explicit  form  of  the  system  equations  in 
such  cases.  A  more  important  aspect  is  related  to  the  basic  difference  between  the 
information  required  from  a  multibody  formalism  by  implicit  and  explicit  integration 
routines.  In  case  of  an  explicit  integration  of  ODE,  the  formalism  must  provide  fm- 
Because  of  this  fact,  all  of  the  multibody  formalisms  presented  previously  headed 
towards  an  efficient  generation  of  the  right  hand  side  u  of  the  system  equations. 
By  contrast,  implicit  integrators  for  DAE  need  the  residual  Am-  In  view  of  (2)  the 
elements  of  Am  can  be  interpreted  as  (generalized)  forces,  strictly  speaking  as  those 
forces,  which  must  be  added  to  the  forces  G^A  -i-h  to  satisfy  the  equations  of  motion 
for  the  given  values  im.im  and  tm-  The  c.''mputation  of  forces  given  the  system 
motion  is  known  as  the  inverse  problem  of  dynamics.  It  has  been  studied  carefully 
for  applications  in  robotics  and  efficient  formalisms  to  compute  the  unknown  forces 
-  here  the  residuals  -  have  been  developed  in  this  context  (17). 

In  view  of  this  interpretation  there  are  three  options  to  compute  the  residual  Am  of 
the  partially  reduced  system  equations  in  terms  of  relative  variables: 

1.  Computation  of  the  system  matrices  in  (2)  using  any  suitable  formalism.  This 
yields  a  computational  effort  growing  quadratically  with  the  number  jV  of  system 
bodies. 

2.  Application  of  the  recursive  C>(iV)-formalism  to  compute  accelerations  ^m  corre¬ 
sponding  to  the  given  values  Xm  and  tm-  This  yields  the  residual  Am  =  im—  im 
with  a  computational  effort  depending  linearly  on  N- 

3.  Usage  of  a  formalism  for  direct  computation  of  Am  as  provided  by  the  methods 
for  solving  the  inverse  problem  of  dynamics.  Such  a  formulation  -  referred  to 
here  as  a  "residual  .algorithm”  -  is  also  of  O(A'). 

The  computational  effort  required  in  the  three  cases  has  been  analyzed  as  a  function  of 
the  number  N  of  the  system  bodies.  The  result  is  summarized  in  Fig.  2.  The  diagram 
shows  the  well  known  advantage  of  C?(Af)-formalisms  (method  2)  as  compared  to 
classical  formulations  (method  1).  A  new  and  more  important  result  is  an  additional 
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Figure  2:  Computational  costs  for  generating  the  residual. 
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reduction  of  the  computational  effort  -  see  Fig.  2,  method  3  -  achieved  when  using 
instead  of  the  0(7V)-formalism  the  residual  algorithm,  which  has  been  developed 
in  (2|.  The  different  slopes  of  the  two  curves  for  the  methods  2  and  3  correspond 
to  a  factor  4.5  fay  which  the  residual  algorithm  is  faster  than  the  recursive  0(N)- 
formulation  (method  2). 

To  summarize,  a  combined  consideration  of  dynamical  and  numerical  aspects  leads 
to  the  following  conclusions:  A  generation  of  the  explicit  system  equations  (3)  is 
excluded  together  with  an  application  of  the  corresponding  numerical  solution  tech¬ 
niques.  Instead,  the  descriptor  form  (4)  is  used  as  a  basis  for  simulation.  Thus  only 
two  of  the  three  options  available  in  dynamics  survive:  implicit  representation  of  the 
system  motion  in  terms  of  absolute  and  relative  variables.  In  both  cases  the  resi¬ 
dual  Am  must  be  generated  for  numerical  integration.  For  the  system  equations  in 
terms  of  relative  variables  the  residual  is  generated  most  efficiently  with  the  residual 
algorithm,  as  demonstrated  by  Fig.  2. 

Considering  the  interactions  with  the  last  corner  of  the  triangle  from  Fig.  1,  computer 
science,  both,  additional  computational  aspects  resulting  in  additional  options  as 
well  as  a  reduction  of  the  options  already  available  are  obtained.  Heading  for  an 
implementation  on  a  parallel  computer  architecture  the  potential  for  parallelization 
must  be  explored.  The  computations  required  for  multibody  system  simulation  can 
be  parallelized  on  three  levels: 

1.  One  may  consider  to  parallelize  basic  mathematical  operations,  primarily  matrix 
operations  for  solving  problems  of  linear  algebra,  required  to  generate  and  solve 
the  implicit  system  equations.  This  is  what  is  called  a  parallelization  on  a  "fine 
grain  level”. 

2.  On  a  "medium  grain  level”  the  residual  Am  may  be  generated  by  computing 
those  contributions  to  Am  in  parallel,  which  result  from  the  various  elements  of 
the  multibody  system  (bodies,  joints,  etc.).  [2]. 

3.  Parallelism  on  a  "coarse  grain  level”  is  obtained  following  another  strategy.  Re- 
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peatedly  calling  the  residual  algorithm  one  obtains  the  Jacobian  of  F.  which  is 
needed  by  the  implicit  integration  scheme.  The  calls  are  independent  of  each 
other  and  can  be  organized  in  parallel. 

The  basic  difference  between  a  parallelization  on  the  medium  and  the  coarse  grain 
level  is  as  follows:  on  the  medium  grain  level  the  residual  is  calculated  in  parallel 
combined  with  a  serial  computation  of  the  Jacobian.  Vice  versa,  on  the  coarse  grain 
level  a  serial  implementation  of  the  residual  algorithm  is  used  and  the  Jacobian  is 
computed  in  parallel. 

In  addition  to  these  alternatives  we  also  must  consider  the  still  remaining  option  of 
computing  based  on  equations  (2)  in  terms  of  absolute  variables.  The  generation 
of  Am  is  so  simple  in  this  latter  case  that  its  parallelization  results  in  no  significant 
benefits.  The  remaining  part  of  the  simulation  problem,  the  solution  of  the  system 
equations  in  terms  of  absolute  variables  based  on  the  computation  of  Am  (which 
is  the  time-consuming  part  in  this  approach)  involves  linear  algebra  computations 
only.  Numerical  experience  teaches  that  a  parallelization  of  linear  algebra  operations 
does  not  pay  off  for  orders  of  matrices  typical  in  multibody  system  simulation  [3). 
This  excludes  two  options,  the  usage  of  absolute  variables  at  all  and  a  fine  gr:*in 
parallelization  of  a  simulation  based  on  the  partially  reduced  system  equations  in 
terms  of  relative  variables.  The  two  other  candidates  of  medium  and  coarse  grain 
parallelization,  as  mentioned  above,  remain  competitive. 

In  summary,  interdisciplinary  considerations  yield  the  result  that  implicit  integration 
of  the  partially  reduced  system  equations  in  terms  of  relative  variables  is  the  candidate 
for  a  parallelization  of  multibody  system  simulation.  A  numerical  solution  of  the 
system  equations  requires  the  computation  of  the  residucil  Am-  The  implementation 
of  the  equations  to  compute  the  residual  may  be  pursued  following  the  two  strategies 
of  medium  and  coarse  grtun  parallelization.  The  implicit  formulation  of  the  problem 
results  in  one  of  the  advantages  of  the  approach,  its  capability  to  deal  with  stiff 
system  equations. 

3  Parallel  Implementation 

The  two  alternatives  of  medium  and  coarse  grain  parallelization  have  been  identified 
as  candidates  for  the  implementation  of  the  multibody  system  equations  as  required 
for  implicit  numerical  integration.  Within  the  process  of  parallelization  identical  work 
packages  are  formulated,  which  can  be  treated  simultaneously  for  both  of  the  alter¬ 
natives  [2].  Having  clarified  such  details  depending  on  the  -'tructure  of  the  equations 
of  motion,  two  major  points,  a  software-  and  a  hardware-problem,  require  further 
consideration:  The  concept  for  parallelization,  i.e.  the  software  needed  to  distribute 
the  work  packages  on  a  given  topology  of  computing  nodes’  must  be  defined,  and 
this  topology  of  computing  nodes,  resulting  in  the  best  suited  hardware  architecture 

’A  computing  node  as  used  in  this  context  is  a  more  general  term  for  a  processor  or  a  collection 
of  processors. 


103 


for  solving  the  simulation  problem,  must  be  selected.  Both  of  these  problems  >11  be 
discussed  in  more  detail  now. 

The  most  important  criterion  for  the  selection  of  the  concept  for  parallelization  is  the 
development  of  a  "user-friendly”  simulation  code.  Shifting  any  of  those  problems  to 
the  user,  which  can  be  handled  by  the  computer,  must  be  avoided.  In  particular. 

•  a  user  should  not  be  occupied  vith  the  question  of  how  to  distribute  work  pack¬ 
ages, 

•  the  topology  of  the  multi  processor  network  should  be  independent  of  the  multi¬ 
body  system  topology, 

«  the  problem  of  load  balancing  “hould  be*  sol'  automatically,  i.e.  a  user  should 
not  be  asked  to  take  c'>xe  of  hvW  to  dLstnbu.e  U;-  computational  load  within  the 
network  in  a  uniform  way, 

•  adding  computing  nodes  to  the  net..  ■>  •  si. oo.d  result  in  a  reduction  of  simulation 
lime  wi>bo'('  additional  programming  elibrt. 


Figure  3'  Organization  of  the  distribution  of  work  load  in  a  computational  network 
by  means  of  the  s  ..ling  concept. 


The  farming  concep%  piopos.J  in  {lOj,  meets  all  of  the  above  mentioned  require¬ 
ments.  As  visualized  in  Fig.  3,  the  computing  nodes  are  subdivided  into  the  two 
groups  of  one  single  "farmer”  and  an  arbitrary  number  of  "workers".  Whenever  the 
f-irmer  recei  /es  an  order,  he  separates  it  into  an  appropriate  number  of  identical  work 
packages  (e.g.  the  computation  of  a  complete  Jacobian  into  the  computations  of  its 
individual  columns).  Then  the  farmer  sends  these  work  packages  into  the  farm,  where 
the  workers  solve  three  problems:  distribution  of  work  packages,  computation,  i.e. 
execution  of  work  packages  and  delivery  of  results  back  to  the  farmer.  The  farmer 
keeps  control  of  the  number  of  outgoing  work  packages  and  incoming  result  packages. 
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This  avoids  an  overload  of  the  farm  and  ensures  thai  ilie  number  of  work  packages  is 
decoupled  from  the  number  of  workers  available.  The  distribution  of  work  packages 
by  the  workers  themselves  guarantees  both,  a  uniform  distribution  of  the  work  load 
and  the  possibility  to  deal  with  an  arbitrary  processor  topology.  In  particular,  in 
case  of  multibody  simulation  the  latter  property  avoids  adapting  the  topology  of  the 
processor  network  to  the  topology  of  the  muitibody  system.  The  parallelized  code 
presents  itself  to  the  user  in  the  same  way  a?  any  conventional  serial  code  running  on 
a  single  processor. 
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Figure  4:  Different  structures  of  multiprocessor  systems. 


Some  hints  deeding  with  the  second  point  mentioned  above,  the  choice  of  the  hardware 
architecture  for  multibody  simulation,  are  summarized  now  [2).  .^s  in  case  of  the 
first  problem,  the  criteria  for  selecting  a  parallel  computer  architecture  are  collected 
first:  The  architecture  should  be  well  suited  for  applying  the  farming  concept,  it 
should  not  result  in  a  conceptual  bottleneck  for  communication  and  it  should  be  eeisy 
to  expand.  Two  groups  of  parallel  computer  architectures  have  been  proposed,  the 
shared  memory  systems  and  the  distributed  memory  systems  as  represented  in  Fig.  4. 
In  the  first  case  the  processors  share  one  common  memory  and  functions  for  network- 
(disc-  and  bus-)  control.  The  interconnection  of  the  processors,  of  the  memory  and 
of  the  control  units  by  a  single  bus  yields  a  limited  communication  bandwidth  and 
results  in  a  communication  bottleneck  when  increasing  the  number  of  processors.  By 
contrast,  in  a  distributed  memory  system  each  single  processor  has  its  own  memory 
and  its  own  communication  supports.  The  processors  are  interconnected  to  each 
other  directly.  As  a  result  the  communication  bandwidth  grows  with  the  number  of 
processors  and  the  bottleneck  resulting  from  communication  by  means  of  a  single  bus 
disappecirs. 
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Figure  5:  Relative  performance  of  multiprocessor  systems. 


Figure  6;  Transputer  architecture  and  its  representation  by  a  symbol. 


A  comparison  of  the  computational  performance  of  the  two  systems  is  shown  in  Fig. 
5.  As  long  as  the  number  of  processors  is  low,  shared  memory  systems  are  slightly 
superior  as  compared  to  distributed  memory  systems,  but  when  the  number  of  proces¬ 
sors  has  grown  beyond  a  certain  limit,  the  advantages  of  distributed  memory  systems 
become  more  and  more  pronounced.  The  reason  for  this  apparent  disadvantage  of 
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shared  memory  systems  lies  in  their  conceptual  bottleneck  for  communication  by 
means  of  the  system  bus.  By  contrast,  distributed  memory  systems  avoid  such  a 
bottleneck,  they  can  be  expanded  easily  and  they  are  well  suited  for  applying  the  far¬ 
ming  concept;  one  processor  can  be  assigned  to  be  the  farmer  and  the  others  become 
the  workers,  all  of  them  being  interconnected  directly  with  each  other.  Thus,  in  view 
of  our  criteria,  distributed  memory  systems  are  well  suited  for  multibody  simulation. 

The  Transputer  shown  in  Fig.  6  can  be  used  as  a  building  block  to  generate  large  dis¬ 
tributed  memory  systems.  The  Transputer  (the  word  is  a  combination  of  transmitter 
and  computer)  has  been  developed  by  INMOS  (5).  It  was  the  first  microprocessor 
combining  processors  (CPU,  FPU),  memory  (EMI,  RAM),  and  communication  sup¬ 
port  (Links)  on  one  single  chip. 


KeyDoaid 


Disc 


Screen 


Host  ~] 


0 


Transputer^ 


0  0  0 


Figure  7:  Host  computer  together  with  a  Transputer  network. 

Because  of  the  links  Transputers  can  be  interconnected  easily  in  an  arbitrary  way  to 
generate  a  network  -  see  Fig.  7.  When  the  network  is  linked  to  a  host  computer  (per¬ 
sonal  computer  or  workstation)  to  provide  such  facilities  as  keyboard,  disc-memory 
and  screen,  one  obtains  a  pc  "erful  distributed  memory  multiprocessor  system.  In 
view  of  the  farming  concept  the  Transputer  interconnected  directly  to  the  host  com¬ 
puter  can  be  identified  with  the  farmer  and  the  others  become  the  workers.  This  is 
the  parallel  computer  architecture  to  be  used  here  for  implementing  the  two  alterna¬ 
tives  of  medium  and  coarse  grain  parallelization  of  multibody  simulation  as  outlined 
in  Sect.  2. 
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4  Architecture  and  Capabilities  of  the  Simulation  Package 

i'liree  computer  codes  have  been  developed  to  test  the  computational  efficiency  of  the 
methods  described  heretofore.  A  serial  code  SERSIM  has  been  based  on  the  residuum 
algorithm  described  in  Sect.  2.  It  serves  as  a  standard  to  measure  the  speed-up^ 
gained  by  parallelization  and  it  has  been  used  as  well  to  test  all  of  the  serial  parts 
in  the  parallel  codes.  Two  of  them  are  available,  called  PARSIM.l  and  PARSIMJ2. 
In  PARSIM.l  medium  grain  pariillelization  is  used  to  compute  the  residual,  whereas 
P.-\RSIM.2  follows  the  strategy  of  coarse  grain  parallelization  as  discussed  at  the 
end  of  Sect.  2.  The  entire  simulation  package  including  the  three  codes  SERSIM. 
PARSIM.1  and  PARSIM.2  for  generating  the  residuals  as  required  for  numerical 
integration  makes  the  following  options  available: 

•  generation  of  the  equations  of  motion, 

•  determinations''  ”  .jbi...  .i  configurations, 

•  computation  of  a  ret  of  i.cnsistr  initial  conditions, 

•  kinematic  an.  '  >  ' 

•  simulation,  ini.  :i»;  a  simple  on-line  animation. 


Modeina 

Dksloa 

L# 

Incut 

BATCHGEN 

\ 

Reol 


Anctvw 


SER9M 
PARSIM^  1 
PARSIM^  2 


Anmohon 


1  Evoluotion  1 

mmmm 

1 

1 

Figure  8:  Structure  of  the  simulation  package. 


A  global  representation  of  the  structure  of  the  package  is  given  in  Fig.  8.  A  main 
program  BATCHGEN  is  used  for  dialog-oriented  input  of  the  system  data  (e.g.  for 
the  Iltis-vehicle  shown  in  the  diagram)  and  additional  parameters  for  computatio¬ 
nal  control.  The  program  generates  the  system  data  in  forms  required  for  further 

’The  speed-up  is  defined  as  the  ratio  of  the  computer-time  for  evaluation  of  an  expression 
required  by  a  number  of  processors  greater  than  one  as  compared  to  the  time  needed  by  a  single 
processor. 
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computation.  Together  with  initial  values  and  control  parameters  the  system  data  | 

are  used  to  start  the  analysis  part,  which  produces  the  results  for  further  evaluation  i 

together  with  an  on-line  animation.  The  analysis  part  yields  the  static  equilibrium  j 

configuration,  consistent  initial  conditions  and  the  system  motion  for  a  given  interval  [ 

of  time,  using  any  of  the  three  codes  SERSIM.  PARSIM.l  and  PARSIM-2.  With  j 

the  third  part  of  the  package  time  histories  can  be  plotted  using  the  PICT2-code  ^ 

(available  at  DLR)  or  any  standard  features  provided  by  MATHEMATICA.  j 

5  Results 

j 

Two  typical  applications  of  multibody  system  simulation  -  the  analysis  of  the  motions  | 

of  an  ofF-road  vehicle  and  of  a  multiple  body  pendulum  -  are  discussed  now  with  J 

regard  to  | 

•  verification  of  the  code, 

•  reduction  of  computer-time  due  to  the  new  C>(A^)-residual  algorithm  and  its 
parallel  implementation, 

•  relative  performance  of  medium  and  coarse  grain  parallelization. 


Figure  9:  Multibody  model  of  an  ofF-road  vehicle. 


The  first  example  is  the  litis  ofF-road  vehicle  depicted  in  the  ’’Real  System”-box  of 
Fig.  8.  Its  multibody  model,  represented  in  Fig.  9,  has  been  used  as  a  benchmark 
problem  for  multibody  simulation  codes  [13].  The  model  shows  the  car  body  with 
four  identical  McPherson  suspensions  and  includes  complex  force  laws  for  the  leaf 
springs  and  the  tires. 
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IIUs  Romp-lo-Steo  Steer 


Figure  10:  Yaw  rate  of  the  car  body  of  the  litis  off-road  /ehicle. 


IIUs  Romp-to-Slep  Steer 


Figure  11:  Lateral  acceleration  of  the  car  body  of  the  litis  off-road  vehicle. 


Motions  of  the  vehicle  are  excited  by  a  ’’Ramp-to-Step  Steer"  maneuver  due  to  a 
displacement  of  the  rack  given  by 


0.4  mm/s  *  t 
2.0  mm 


0.0s  <<  <  0.5s 
0.5s  <  t  <  5.0s 


It  commands  a  steering  motion  of  the  front  wheels  of  the  vehicle  resulting  in  a  change 
o'  the  direction  of  travel  from  straight  track  to  a  (circular)  curve.  A  detailed  descrip- 
tion  of  the  model  may  be  found  in  (22)  -  here  it  is  sufficient  to  know  that  this 
multibody  system  model  has  10  bodies,  18  joints  and  8  kinematically  closed  loops. 
In  our  approach  the  system  motion  is  represented  by  a  set  of  52  differential-algebraic 
equations.  Motions  due  to  the  rack  displacement  have  been  simulated  for  the  three 
initial  velocities  of  10,  20  and  30  m/s  of  the  vehicle.  Typical  examples  of  simulation 
results  are  given  in  Figs.  10  and  11.  The  diagram  in  Fig.  10  shows  the  time  history 
of  the  yaw  rate  of  the  crir  body  and  the  one  in  Fig.  11  its  lateral  acceleration.  The 
plots  demonstrate  that  the  vehicle  travels  along  a  circle  after  some  transients  due 
to  the  maneuver  have  been  damped  out:  Both,  the  lateral  acceleration  and  the  yaw 
rate  become  constant.  The  stationary  values  of  the  yaw  rates  of  the  vehicle  trave¬ 
ling  with  20  and  30  m/s  are  nearly  identical  -  see  Fig.  10.  This  is  explained  by  the 
fact  that  the  vehicle  runs  along  circles  having  different  radii  in  the  two  cases.  The 
results  are  in  good  correspondence  with  those  obtained  using  the  SIMPACK-  and 
the  MEDYNA-code  described  in  (20)  and  [25].  The  above  results  verify  the  new 
code,  but  its  relative  performance  with  respect  to  existing  serial  codes  remains  an 
open  question.  Two  options,  medium  and  coarse  grain  parallelization,  are  available 
within  the  simulation  package.  To  select  the  one,  which  is  best  suited  for  simulating 
the  problem  under  consideration,  the  diagram  shown  in  Fig.  12  has  been  created.  It 
shows  the  speed-up  obtained  for  evaluating  both,  the  residual  Am  and  the  Jacobian 
of  F  when  increasing  the  number  of  processors.  The  diagram  shows  clearly  that  a 
parallelization  of  the  computation  of  the  Jacobian  results  in  a  far  better  speed-up 
than  the  parallelization  of  the  generation  of  the  residual.  For  the  simulation  of  the 
litis  vehicle  motions  this  suggests  to  use  the  coarse  grain  strategy  for  parallelization, 

i.e.  the  PARSIM^  option  of  the  simulation  package. 


I 
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Applying  SERSIM  emd  PARSIM^  we  now  ask  the  following  questions: 

1.  How  does  the  parallelized  code  compare  with  the  performance  of  the  MEDYNA- 
code,  which  has  been  developed  with  specicd  attention  to  vehicle  dynamics  ap¬ 
plications?  Such  a  compcirison  is  of  particular  interest,  because  MEDYNA  uses 
a  system  representation,  in  which  the  kinematics  are  linearized,  resulting  in  con¬ 
siderable  computational  savings. 

2.  How  does  the  new  code,  based  on  the  new  0{N)  residual  algorithm  compare  to 
the  SIMPACK -code,  which  uses  the  "classical"  recursive  0(A^)-formulation  for 
the  generation  of  the  system  equations? 

3.  What  tire  the  benefits  of  using  several  processors  instead  of  one  single  processor 
only?  This  question  can  be  answered  by  comparing  the  performance  of  PAR- 
SIM^  and  SERSIM. 


Ill 
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Figure  12:  Speed-up  in  case  of  medium  and  fine  grain  parallelization. 

Answers  to  the  three  questions  are  summarized  in  Table  1.  It  gives  the  CPU-times 
for  running  the  same  problem  with  the  codes  mentioned  in  the  first  column  and  with 
the  numbers  of  processors  shown  in  column  3.  The  CPU-times  given  in  column  4  are 
normalized  such  that  the  time  required  by  the  SERSIM-code  is  1.  In  all  of  the  cases 
the  same  (implicit)  integration  routine  ODASSL  has  been  used,  excluding  MEDYN  A. 
This  code  generates  the  explicit  form  of  the  state  space  representation  and  relies  on 
the  explicit  integration  routine  DEABM  [6].  The  facts  demonstrated  by  the  table  are 
as  follows: 

•  The  SERSIM-code,  generating  the  nonlinear  system  equations,  is  nearly  as  fast 
as  the  MEDYNA-code,  in  which  the  kinematics  have  been  linearized. 

•  The  new  0(N)  residual  algorithm  is  much  faster  than  the  ’’classical”  recursive 
0{N)-  formulation  used  in  the  SIMPACK-code.  The  efficiency  of  the  two  ap¬ 
proaches  had  been  compared  in  Sect.  2.  The  factor  4.5  given  in  the  table  justifies 
the  expectations  suggested  by  Fig.  2. 

•  The  simulation  time  is  reduced  considerably  when  using  more  than  one  processor. 
The  speed-up  is  not  as  high  as  one  might  expect  from  Fig.  12.  This  is  understood 
easily,  when  realizing  that  the  Jacobian  is  re-evaluated  in  general  only  for  10  % 
of  the  integration  steps. 

•  The  combination  of  the  new  0{N)  residual  algorithm  and  coarse  grain  paralle¬ 
lization  yields  a  reduction  of  computer-time  of  an  order  of  magnitude  when  com- 
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pared  with  a  serial  implementation  of  the  "classical”  recursive  C?(A^)-formulation 
(CPU-time  4.5  against  0.46). 


code 

integrator 

processors 

CPU-time 

SIMPACK 

ODASSL  (Impl.) 

1 

4.50 

MEDYNA 

DEABM  (expl.) 

1 

0.91 

SERSIM 

ODASSL  (impl.) 

1 

1.00 

PARSIMJ2 

ODASSL  (impl.) 

2 

0.71 

PARSIM^ 

ODASSL  (impl.) 

4 

0.58 

PARSIMJ2 

ODASSL  (impl.) 

8 

impl.  =  impUcit  method;  expi.  =  explicit  method 

Table  1;  Computer-times  required  to  simulate  motions  of  the  off-road  vehicle. 

Finally,  it  may  be  worth  mentioning  the  real  -  not  the  relative  -  computer  times. 
One  single  Transputer  yields  approximately  the  same  computer-times  as  an  apollo- 
Workstation  DN  5500.  The  normalized  time  1  in  the  table  corresponds  to  a  CPU-time 
of  18.3  s  on  the  apollo,  required  to  simulate  the  5  s  of  the  vehicle  motion  shown  in 
the  Figs.  10  and  11. 
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Figure  13:  Multiple  body  pendulum. 


The  second  example,  a  22-body  pendulum  as  shown  in  Fig.  13,  demonstrates  that 
the  optimal  strategy  for  parallelization  depends  on  the  problem.  Multiple  pendulum 
systems  have  been  used  as  models  for  the  simulation  of  the  motions  of  cables  [9J.  In 
particular,  the  laws  for  the  forces  between  the  system  bodies  become  quite  complica¬ 
ted  in  such  applications.  The  diagrams  in  Fig.  14  show  the  relative  computer-times 
required  for  the  simulation  of  the  motions  of  the  system  using  various  codes  and  an 
increasing  number  of  processors.  Again  the  computer-time  has  been  normalized  to 
obtain  the  value  1  in  the  case  of  a  simulation  by  the  SERSIM-code. 

The  pendulum  model  has  a  tree  configuration,  in  fact  it  is  a  simple  chain.  In  such 
cases  the  SIMPACK-code  generates  the  explicit  form  (3)  of  the  system  equations. 
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Figure  14;  Computer-times  required  for  the  simulation  of  the  multiple  body  pendu¬ 
lum. 


Using  the  explicit  integration  routine  DEABM  one  obtains  a  normalized  simulation 
time  of  4.46  as  shown  in  Fig.  14,  compared  to  1  required  by  SE.RSIM  when  using  the 
implicit  integrator  DASSL.  The  latter  time  is  reduced  as  shown  by  the  diagrams  when 
using  more  than  one  processor  and  the  two  parallel  codes  PARSIM.1  and  PARSIM.2. 
The  example  demonstrates  that  it  is  more  advantageous  to  apply  PARSIM-1  in  this 
case,  i.e.  to  follow  the  strategy  of  medium  grain  parallelization.  With  this  concept 
and  with  8  processors  one  obtains  a  reduction  of  simulation  time  by  a  faccor  of  23  with 
respect  to  the  point  4.46  marked  in  the  diagram  for  the  ’’classical"  0(A^)-formulation 
implemented  on  a  serial  computer. 

6  Conclusion 

To  exploit  the  benefits  of  parallel  computer  architectures  for  multibody  system  si¬ 
mulation  an  interdisciplinary  approach  has  been  pursued,  combining  knowledge  of 
the  three  disciplines  dynamics,  numerical  mathematics  and  computer  science.  An 
analysis  of  the  options  available  yielded  a  surprising  result.  A  method,  initially  pro¬ 
posed  to  solve  the  inverse  problem  of  dynamics,  is  the  best  choice  to  generate  the 
system  equations  required  for  solving  the  simulation  problem,  when  relying  on  impli- 
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cit  integration  routines.  Such  routines  have  the  particular  advantage  of  handling  stiff 
systems,  too.  The'  new  0(N)  residual  formalism,  generating  the  system  equations 
in  a  form  required  for  implicit  numerical  integration,  has  a  high  potential  to  benefit 
from  parallel  computer  architectures.  Two  strategies  of  medium  and  coarse  grain 
parallelization  have  been  implemented  on  a  Transputer  network  to  obtain  a  package 
for  parallel  multibody  simulation.  An  analysis  of  the  performance  of  this  package 
demonstrates  for  typical  multibody  simulation  problems: 

•  The  new  code  is  five  times  faster  than  e.visting  codes  when  implemented  on  a 
serial  computer. 

•  An  additional  speed-up  by  the  same  order  of  magnitude  is  obtained,  when  the 
code  is  implemented  on  a  Transputer  network. 

•  The  relative  advantages  of  the  two  strategies  of  medium  and  coarse  grain  paral¬ 
lelization,  available  with  the  code,  depend  on  the  problem. 

In  particular,  the  simulation  program  does  not  ask  the  user  to  distribute  work  pack¬ 
ages  in  the  network.  The  implemented  farming  concept  takes  care  of  such  problems 
automatically  and  the  program  presents  itself  in  the  same  way  as  any  serial  code. 

The  serial  implementation  of  the  new  code  is  supplementary  to  the  methous  available 
in  SIMPACK.  It  will  be  added  to  this  multibody  simulation  package  to  increase  its 
computationtil  performance. 
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ABSTRACT.  Difcuited  in  thu  contribution  it  n  puticulnr  nppronch  for  tackling  the  problem  of  for¬ 
mulating  tbe  equationt  of  motion  of  minimal  order  for  complex  mechanical  ays  terns.  The  obective  is 
to  arrive  at  a  system  of  pure  differential  equations,  which  is  robust  and  for  which  efficient  integration 
techniques  exist.  This  ie  achieved  by  a  special  treatment  of  the  kinematics,  which  are  formulated 
by  consideration  of  closed-form  solutions  for  the  subsystems  where  this  is  possible  and  reducing  the 
generation  of  dynamical  equations  to  a  repetitive  evaluation  of  the  kinematics.  Discussed  in  the 
paper  are  the  necessary  te^niques  for  solving  the  arising  subproblems,  from  methods  for  finding 
closed-form  solutions  in  single-  and  multi-loop  systems  to  the  incorporation  of  non-holonomic  con¬ 
straints.  Also,  some  remarks  are  given  concerning  the  implementation  of  the  methods  based  on 
modern  programming  paradigms,  such  as  object-oriented  programming  and  symbolic  al  formula  ma¬ 
nipulation.  The  key  concepts  are  illustrated  by  several  examples,  among  which  are  actual  research 
objects  and  ^tplicftions  in  cooperation  with  industry. 

1.  Introduction 

Tbe  dynamics  of  multibody  system  dynamics  is  a  field  of  research  since  now  more 
then  30  years,  and,  since  its  beginnings,  several  outstanding  approaches  have  emerged 
which,  in  part,  have  reached  commercial  maturity.  Papers  like  tbe  one  of  Hooker  and 
Marguiies  1965  or  Roberson  and  Wittenburg  1968  are  typical  examples  of  early  pub¬ 
lications  in  this  field,  while  names  such  as  IMP  (Sbeth  and  Dicker  Jr.  1972),  DAMN 
(Chace  and  Smith  1971),  ADAMS  (Orlandeaet  al.  1979),  DADS  (Wehage  and  Haug 
1982),  NEWEUL  (Kreuzer  1979),  COMPAMM  (Garcia  de  Jalon  et  al.  1986),  MESA 
VERDE  (Wittenburg  and  Wolz  1985),  MECANO  (Geradin  and  Cardona  1989)  and 
SIMPACK  (Rulka  1990)  stand  for  “turn-key”  program  packages  endowed  with  easy- 
to-use  graphical  interfaces  and  universal  schemes  for  automatic  equation  generation 
by  means  of  which  the  engineer  is  freed  from  the  burden  of  establishing  the  model 
equations  of  the  system.  The  German  Research  Council  (DFG)  has  even  just  finished 
a  nationwide  five-year  research  project  devoted  to  dynamics  of  multibody  systems, 
gathering  some  of  tbe  best  contemporary  multibody  formalisms  in  a  new  general 
purpose  program  (Schiehlen  1993).  Why  thus  a  further  approach? 

The  reason  for  t'le  developing  the  present  approach  lies  in  the  fact  that,  in  in¬ 
dustry,  for  complex  systems  and  corresponding  applications  still  a  lot  of  modelling  is 
performed  by  hand,  because  engineers  find  that  (a)  such  programs  can  be  “tuned” 


to  run  faster,  including  hardware-in-the-loop  applications,  (b)  hand-tailored  program 
modules  implementing  non-standard  solution  techniques  can  be  more  easily  incor¬ 
porated,  and  (c)  these  programs  are  better  understood.  As  it  turns  out,  for  many 
practical  systems  huge  parts  of  the  underlying  equations  can  be  solved  either  in 
closed  form  or  in  some  simplifying  manner,  and  incorporation  of  these  solutions  into 
the  general  procedure  is  (today)  only  possible  with  the  help  of  human  intelligence. 

The  objective  of  this  paper  is  to  show  some  techniques  and  systematics  for  helping 
the  designer  to  establish  where  closed  form  solutions  may  arise  in  the  system,  and 
how  to  incorporate  them  into  the  dynamics-generation  procedure.  This  knowledge 
can  be  used  for  establishing  the  equations  of  motion  of  minimal  order  for  quite  gen¬ 
eral  systems,  and  thus  to  incorporate  very  efficient  computer-models  of  mechanical 
systems  into  more  sophisticated  programming  environments.  It  is  also  intended  to 
present  the  main  results  of  the  work  done  by  the  author  and  his  co-workers  in  the 
recent  years. 

The  rest  of  the  paper  is  organized  as  follows:  After  giving  an  overview  of  the  basic 
steps  of  the  overall  procedure  based  on  the  example  of  the  modelling  of  the  dynamics 
of  an  upper-class  passenger  car  in  Section  2,  the  idea  of  reducing  the  dynamics  to 
a  repetitive  evaluation  of  the  kinematics  is  presented  in  Section  3.  At  the  heart  of 
the  approach  is  the  problem  of  appropriately  solving  the  kinematics  of  the  single 
loop,  which  is  discussed  in  Section  4.  Here,  the  systematic  of  the  “Characteristic 
Pair  of  Joints”  for  establishing  appropriate  closure  conditions  is  elaborated,  and  a 
short  overview  of  a  method  for  determination  of  the  polynomial  of  minimal  order 
for  the  general  case  is  given.  Also,  a  scheme  for  the  automatic  determination  of 
closed-form  solutions,  where  possible,  is  described.  Section  5  addresses  the  problem 
of  the  dissection  of  a  general  multi-loop  system  into  modules  which  can  be  used  for 
incorporating  the  results  of  the  previous  section  into  the  general-case  problem.  This 
is  achieved  by  regarding  the  independent  multibody  loops  as  individual  “kinematical 
transformers”  which  are  then  coupled  together  by  linear  equations  to  make  up  the 
original  general  multilooped  system.  Section  6  covers  the  treatment  of  non-holonomic 
constraints,  showing  as  an  example  of  a  complex  application  a  combined  wheeled  and 
legged  vehicle.  Finally,  in  Section  7  some  remarks  concerning  implementation-specific 
issues  are  given. 

2.  Basic  Modelling  Steps  in  the  Minimal  Coordinate  Approach 

Various  techniques  exist  for  transforming  a  real  technical  system  into  a  mechanical 
model  depending  on  the  kind  of  investigation  to  be  carried  out.  As  an  example, 
consider  the  simulation  of  llie  dynamics  of  a  passenger  car  with  active  components 
such  as  anti-lock-systeras  (ABS)  and  drive-slide-control  (ASR)  (see  Fig.  1  and  Fig.  2). 
Here,  eigenfrequencies  of  the  system  up  to  25  Hz  have  to  be  taken  into  account,  which 
is  accomplished  by  representing  the  complete  vehicle  as  a  multibody  system  including 
the  full  nonlinear  kinematics  of  the  wheel  suspensions,  the  suspension  of  the  engine 
together  with  the  powertrain,  as  well  as  dynamic  tire  models.  In  addition,  elasticities 
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Figure  1:  Upper-class  passenger  car. 


Figure  2:  Model  of  the  passenger  car. 

The  corresponding  multibody  system  is  characterized  by  a  complex  topology  with 
many  kinematical  loops  (see  Fig.  3).  To  obtain  the  dynamical  equations  of  motion 
in  minimal  coordinates,  the  global  kinematics  of  the  system,  describing  the  motion 
of  all  bodies  in  the  system  with  respect  to  the  inertial  frame,  is  required.  For  this 
purpose,  the  following  modelling  steps  are  i.ntroduced: 

1.  Decomposition  of  the  y/o&al  kinematics  into  relative  and  absolute  kinematics  by 
introducing  joint  coordinates.  Thus  the  originally  large  set  of  implicit  equations 
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in  absolute  coordinates  is  separated  into  a  small  set  of  implicit  or  partly  implicit 
equations  governing  the  relative  kinematics  and  a  set  of  explicit  equations  for 
the  absolute  kinematics  (see  Section  3). 

2.  Decomposition  of  the  equations  for  the  relative  kinematics  into  components  cor¬ 
responding  to  individual  kinematical  loops  or  subsystems  of  several  kinematical 
loops.  These  components  are  then  treated  as  “kinematical  transformers”  (see 
Sections  4,  5  and  6). 

3.  Determination  of  closed-form  solutions  for  individual  components,  if  possible. 
For  example,  the  five  kinematical  loops  contained  in  the  front-axle  of  the  ve¬ 
hicle  shown  in  Fig.  3  can  be  explicitly  solved  as  individual  loops  and  also  as  a 
complete  subsystem  (see  Sections  4,  5  and  6). 

4.  Assembly  of  the  solution  of  the  individual  components  to  obtain  the  global  kine- 
,  matics  of  the  complete  multibody  system  (see  Fig.  4).  The  use  of  object-oriented 

programming  techniques  permits  this  assembly  process  to  be  implemented  in  a 
simple  and  intuitive  manner  (see  Section  7). 

5.  Generation  of  the  overall  dynamical  equations. 


I 


Figure  4:  Assembly  of  the  components  of  the  passenger  cars. 


3.  Equations  of  motion  for  complex  multibody  systems  with  minimal 
coordinates 

3.1.  Dynamics 


The  equations  of  motion  for  general  multibody  systems  can  be  stated  starting  from 
d’Alembert’s  principle.  This  principle  applied  to  a  scleronomic,  holonomic  or  non- 
holonomic  multibody  system  consisting  of  ng  rigid  bodies  reads  (see  also  Hiller  and 
Kecskemethy  1989) 


^  [  (m,-  as,  -  f‘)  ■  Ssi  +  (&si  tifi  +  u>,-  x  ©5,  w,-  - 
i=l 


=0 


where,  for  body  B,-, 
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mass, 

tensor  of  mass-inertia, 

resultant  vector  of  applied  forces, 

resultant  vector  of  applied  torques  at  center  of  gravity, 

vector  of  acceleration  of  center  of  gravity, 

vector  of  angular  velocity, 

vector  of  angular  acceleration, 

vector  of  virtual  displacement  of  center  of  gravity, 

vector  of  virtual  rotation. 
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All  vectors  appearing  in  Eq.  (1)  are  tensors  of  valence  one,  thus  £q.  (1)  is  stated 
in  a  component-independent  form.  Note  that  the  constraint  forces  do  not  appear 
in  Eq.  (1)  because  the  virtual  displacements  £«,-  and  6<f>i  are  assumed  to  be  com¬ 
patible  with  all  the  constraints  imposed  on  the  system.  For  the  general  case  where 
the  virtual  displacements  Sti  and  6<f>i  are  not  independent,  one  introduces  /  inde¬ 
pendent  generalized  coordinates  q  =  (91,.. -,9/]^  with  corresponding  independent 
virtual  displacements  Sg  =  [£91, . . . ,  £9/p,  /  being  the  number  of  degrees  of  freedom 
of  the  multibody  system.  The  dependent  virtual  displacements  are  related  to  the  in¬ 
dependent  virtual  displacements  by  linear,  homogeneous  transformations  which  can 
be  obtained  directly  from  the  velocity  transformations 

=  ,  U{  =  JuiS.  (2) 

by  substituting  velocities  with  virtual  displacements: 

SMi  =  J,i  Sq  ,  S<j){  =  Ju)i  d£  .  (3) 

The  3  X  /  transformation  matrices  J,,-  and  Ju>,-  are  still  to  be  determined. 

The  relationships  between  the  dependent  and  independent  accelerations,  are  de¬ 
rived  from  Eq.  (2)  as 

2  +  jsi  i  »  Wi  =  Ja;,-£+ ju.,  £  .  (4) 

Insertion  of  these  transformations  into  d’Alembert’s  principle  yields,  due  to  the  in¬ 
dependency  of  virtual  displacements  Sqi, . . . ,  Sq/,  the  equations  of  motion  of  minimal 
order 

Mg  +  b  =  g^,  .  (5) 

where  the  /  x  /  generalized  mass-matrix  M ,  the  /  x  1  matrix  of  generalized  centrifugal 
and  Coriolis  forces  6  and  the  /  x  1  matrix  of  generalized  applied  forces  Q  read, 
respectively, 

^il)  =  Jsi  +  Ju;JeiJui]  , 

1=1 

f  •  /  ■  \1 

J,7  Js,£-b  Ju>7  (©.■ 

<=1 

fi(2’2)  =  fi  +  JuJ  Ti]  . 

i=l 

Once  the  transformation  matrices  J«,-  and  Jfa>{  are  established,  the  problem  of  stat¬ 
ing  the  equations  of  motion  of  minimal  order  is  solved.  The  difficulty  for  complex 
multibody  systems  is  that  the  transformations  Eq.  (2)  to  Eq.  (4)  are  mostly  hard  to 


(6) 

(7) 

(8) 


obtain.  Although  the  position  coordinates  of  the  bodies  are  known  to  be  analytic 
functions  of  the  generalized  coordinates 


where  A,-  denotes  the  tensor  measuring  the  rotation  of  body  Bi  with  respect  to  the 
inertial  frame,  these  fimctions  are  generally  not  known  explicitly.  Thus  defining  J«,- 
and  Ju)i  by  ansdytical  differentiation,  as  in 


leads  to  very  long  formulas  which  cannot  be  applied  to  complex  multibody  systems. 
For  this  reason,  most  of  the  present  methods  avoid  this  kind  of  formulation  by  using 
LAGRANGE-multipliers.  This  is  equivalent  to  “transfering”  some  —  or  all  —  of  the 
constraints  from  the  kinematics  to  the  dynamics.  A  full  solution  of  the  kinematics, 
from  which  the  quantities  needed  for  the  transformations  in  Eqs.  (3)  and  (4)  can 
be  determined  easily  is  described  in  Hiller  et  al.  1986.  In  this  paper,  this  method 
is  applied  to  produce,  using  kinematical  differentials,  suitable  expressions  for  the 
transformations  in  Eqs.  (2)  and  (4). 

Suppose  that  an  effective  formulation  of  the  global  kintmatics  exists  for  a  given 
multibody  system,  which  provides  the  relationships  between  position,  velocity  and 
acceleration  of  all  bodies  for  given  values  of  the  generalized  coordinates  and  their 
time  derivatives,  as  shown  in  Fig.  5.  Obviously,  these  relationships  can  be  evaluated 
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Figure  5:  Global  Kinematics 

for  any  set  of  values  of  the  generalized  velocities  91, ... ,  qj.  In  particular,  evaluating 
the  kinematics  for  a  fixed  position  and  a  special  set  of  generalized  velocities 


Mi)  _  f  1  if  j  =  i 
I  0  otherwise 


for  j  =  1, . . . ,  /  , 


yields  pseudo-velocities  and  which,  compared  with  Eq.  (2),  give  just  the 
j-th  column  of  the  transformation  matrices  J„-  and  Jui,  respectively.  Similarly, 
evaluation  of  the  kinematics  for  fixed  position  and  fixed  velocity,  but  with  the  special 
generalized  accelerations 

9  =  0,  (12) 


fc-  Bun 


yields  the  pseudo-accelerations  o,-  and  Wi  which,  compared  with  Eq.  (4),  equal  the 
terms  jj,  j  and  Ja>i£,  respectively. 

With  these  quantities,  the  differential  relationships  of  Eq.  (3)  and  Eq.  (4)  can  be 
re-stated  as 


•i  = 

i=i 

f/A  ^  \  X/*.  ♦  sN. 


j=i 

_  'e  r.P);:.  j.,?,. 


S<l»,  =  H  w,-  ;  w.-  =  w.-  9,  +u>.- , 

i=i  ) 

and  the  coefficients  for  the  matrices  of  the  equations  of  motion  of  minimal  order  read: 

•  ©«■  I 

1=1 

hj  =  ^  [  m,- •  a,- -f  •  (©,•  w,- -h  X  ©,  u>,)  ]  ..  (14) 

tal  < 

It  should  be  noted  that  by  Eq.  (14)  the  problem  of  stating  the  equations  of  motion 
of  minimal  order  for  arbitrary  multibody  systems  has  been  reduced  to  a  purely  kine- 
matical  problem.  Moreover,  the  coefficients  of  the  equations  of  motion  are  written 
in  terms  of  “physical”  quantities,  i.e.  tensors,  which  are  independent  to  coordinate 
transformations.  Thus,  one  is  still  free  to  choose  an  appropriate  coordinate  system 
for  the  evaluation  of  each  individual  term.  Together  with  the  process  of  determining 
the  partial  derivatives  by  a  simple  re-evaluation  of  the  kinematics  —  denominated 
kinematical  differentials  —  Eq.  (14)  gives  a  very  easy-to-implement  approach  for  stat¬ 
ing  the  equations  of  motion  of  minimal  order.  The  key  to  the  effectiveness  of  this 
method  is  a  particular  formulation  of  the  kinematics,  which  will  be  discussed  next. 

3.2.  Kinematics 

For  a  multibody  system  with  the  independent  coordinates  ?,  position,  velocity  and 
acceleration  of  «ill  bodies  have  to  be  expressed  as  a  function  of  £,£,£•  For  systems 
with  complex  topology,  such  as  those  containing  kinematical  loops,  it  is  suitable  to 
separate  the  calculation  into  the  two  steps  (see  Fig.  6) 

•  relative  kinematics,  where  all  dependent  joint  coordinates  ^  and  its  derivatives 

are  expressed  as  a  function  of  £,£,£• 

•  absolute  kinematics,  in  which,  by  a  forward  kinematics  procedure,  ail  kinemat¬ 
ical  quantities  a{,Ri,Vi,u)i,a,u  for  all  bodies  are  calculated  as  a  function  of 
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Figure  6;  Kinematics  of  multibody  systems  with  closed  loops. 
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Both  steps  are  combined  to  obtain  the  global  kintmatics  described  in  the  preceding 
section  (see  Fig.  5). 

In  the  following,  several  particular  aspects  which  arise  in  multibody  systems  with 
closed  kinematical  loops  will  be  discussed.  Consider  a  spatial  multibody  system, 
consisting  of  ng  moving  rigid  bodies  (i.e.  without  counting  the  inertial  frame),  and 
na  elementary  joints,  i.e.  revolute  or  prismatic  joints  with  a  single  degree  of  freedom. 
According  to  Eq.  (9),  the  position  and  orientation  of  ail  bodies  can  be  stated  as 
nonlinear  analytic  functions  of  /  =  6ns  — ona  generalized  coordinates  qi, . . . An 
alternative,  more  compact  representation  of  Eq.  (9)  is 


£.•=£{(2)  (15) 

where  £.  is  a  6-tuple  holding  three  translational  and  three  rotational  parameters,  or 
a  (6  +  e)-tuple,  e  being  the  number  of  redundant  rotational  parameters.  For  example 

Ei  =  (aJi.  y.-.  2f;  <f>i,  6i,  (16) 


with  coordinates  for  the  reference  point  of  body  i  and  EULER-angles 

(or  another  set  of  rotational  parameters)  for  its  orientation.  The  Op  =  6  ns  position 

coordinates  of  all  bodies  can  be  put  together  in  an  array 


£  =  {£[’ 


(17) 


For  a  general  multiloop  system,  the  functions  in  Eq.  (15)  will  not  be  known  a  priori 
in  closed  form,  instead,  they  are  defined  implicitly  by  a  system  of  6  ns  nonlinear 
equations 


=  i=l,...,6nB,  (18) 

which  consist  of  the  constraints  at  the  joints,  as  well  as  additional  equations  defin¬ 
ing  the  generalized  coordinates  in  terms  of  the  position  parameters  of  the  bodies. 
This  form  represents  a  large  “sparse”  system  of  relatively  simple  equations.  An  al¬ 
ternative  formulation  of  Eq.  (18)  is  obtained  after  introducing  the  joint  coordinates 
5  =  (/?!,. .  .,0ng]^  as  auxiliary  variables  and  then  splitting  Eq.  (18)  into  two  subsys¬ 
tems: 


£  =  rW  • 

g,{0}3)  =  0  :  I  -  I,. ..  ,n0  . 


(19) 

(20) 
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The  first  subsystem  represents  the  forward  kintmatics,  i.e.  the  process  by  which  one 
obtains  the  absolute  motion  of  the  bodies  for  known  relative  motion  at  the  joints. 
This  is  a  task  which  can  always  be  stated  recursively  in  closed  form  and  will  not  be 
discussed  here.  The  second  subsystem,  which  defines  the  functions  implicitly, 
represents  the  relative  kinematics  and  consists  of  a  reduced  system  of  constraint  equa¬ 
tions,  together  with  /  equations  describing  the  choice  of  the  generalized  coordinates 
(Fig.  6).  Note  that  this  choice  can  be  formulated  as  simple  one-one  correspondences 
to  particular  joint  coordinates,  resulting  in  /  of  the  equations  out  of  Eq.  (20)  being 
mostly  trivia!.  The  remaining  rp  =  np  —  /  nonlinear  equations  represent  the  “core” 
of  the  reduced  system  of  constraint  equations. 

In  recent  years,  several  methods  to  state  the  constraint  equations  of  the  “core”  of 
the  reduced  system  have  been  developed.  Among  others,  one  approach  is  based  on 
the  following  concepts: 

•  The  characteristic  pair  of  joints  to  state  the  six  constraint  equations  of  a  single 
multibody  loop  in  a  mostly  recursive  form  (Hiller  and  Woernle  1988).  If  a  fully 
recursive  formulation  is  possible,  this  solution  can  be  found  automatically,  as 
shown  in  Kecskemethy  and  Hiller  1992. 

•  The  concepts  of  kinematical  transformer  and  block  diagram.  Here,  the  indi¬ 
vidual  kinematical  loop  is  treated  as  a  transmission  element,  and  a  complex 
multibody  system  consisting  of  many  closed  loops  -  usually  interconnected  by 
linear  equations  in  the  joint  variables  -  is  represented  as  a  block  diagram.  This 
can  also  be  regarded  as  an  oriented  graph  which  visualizes  the  kinematical  flow 
in  the  system  (Hiller  and  Kecskemethy  1989). 

•  The  concept  of  the  kinematical  differentials  for  an  efficient  evaluation  of  the 
time  derivatives  required  for  the  kinematics  as  well  as  for  the  dynamics.  This 
has  already  been  described  in  the  previous  section. 

4.  Kinematics  of  single  muitibody  loops 

4.1.  Stating  loop  closure  conditions 

Considering  a  single  multibody  loop  L,  consisting  of  nB(L,)  bodies  and  na{L,)  = 
ng  {Li)  elementary  joints,  one  introduces  the  ng{Lf)  =  na  [Li)  (relative)  joint  coor¬ 
dinates  ^{Li)  =  (/3f” ,  . . .  ,  as  auxiliary  variables.  For  these  coordinates  there 
exist,  in  the  general  case,  six  independent  constraint  equations,  which  arise  from  the 
closure  conditions  of  the  loop.  Special  configurations,  where  the  equations  become 
linearly  dependent,  shall  not  be  considered  here.  It  is  then  always  possible  to  define 
six  joint  coordinates  as  functions  of  the  other  /(i,)  =  na  {Li)  -  6  independent  joint 
coordinates.  This  formulation  is  independent  of  the  overall  motion  of  the  loop  and  is 
thus  a  "local”  property  of  the  loop.  Correspondingly,  the  number  /  (L,)  of  indepen¬ 
dent  coordinates  is  called  the  local  degree  of  freedom  of  the  loop,  and  the  process  of 
solving  the  constraint  equations  is  called  relative  kinematics. 
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In  principle,  any  approach  can  be  adopted  for  the  formulation  and  solution  of 
the  constraint  equations,  e.g.  the  well-known  method  of  Denavit  and  Hartenberg 
1955,  where  the  closure  conditions  are  derived  from  the  component  representation  of 
a  ck.  A  chain  of  4  x  4  transformation  matrices.  But  the  drawback  of  such  approaches 
is  that  they  are  not  very  effective  because  the  solutions  must  be  found  numerically. 

There  are  some  principal  methods  for  stating  geometric  closure  conditions  in 
kinematical  loops  which  are  independent  of  a  particular  mathematical  formulation. 

4.1.1.  Disconnection  of  the  multibody-loop  at  a  body.  The  two  halves  of  the  dis¬ 
connected  body  have  to  perform  the  same  motion  relative  to  an  arbitrary  reference 
frame.  The  main  advantage  of  this  approach  is  the  universal  mathematical  formula¬ 
tion  for  multibody-loops  with  arbitrary  joints  and  geometric  dimensions.  However, 
closed  form  solutions  for  the  six  unknown  joint  coordinates  can  be  only  obtained 
by  performing  algebraic  eliminations  from  six  carefully  chosen  independent  closure 
equations  (see  Section  4.4). 

4.1.2.  Disconnection  of  the  multibody-loop  at  a  joint.  Disconnection  of  the  loop  at 
a  joint  with  fa  dependent  joint  coordinates  gives  an  implicit  “core”  system  of  6  - 
fa  closure  equations  in  which  the  fa  joint  coordinates  do  not  appear.  Thus,  fa 
unknowns  are  immediately  eliminated  without  particular  algebraic  manipulations 
being  necessary. 

4.1.3.  The  “Characteristic  Pair  of  Joints”.  Here,  the  kinematical  loop  is  disconnected 
at  two  joints  Qa  and  Qi  having  fg,  and  fg^  degrees  of  freedom,  respectively  (Fig.  7). 
One  obtains  two  open  chains  which  will  be  designated  as  the  “upper  segment”  and 
the  “lower  segment”  of  the  multibody-loop  (see  also  Hiller  et  al.  1986,  Hiller  and 
Woernle  1987,  Woernle  1988).  Then,  the  six  closure  equations  can  be  split  up  into 
two  subsystems.  An  implicit  “core”  system 


ichar  (^fcar'S)  “  2 


(21) 


with 


!  g 


h  =  S-ifg,  +  fg,) 

equations  gives  the  h  dependent  joint  coordinates  not  belonging  to  the  char¬ 
acteristic  pair  of  joints.  Thus  a  maximum  number  of  A  =  4  equations  occurs  if  the 
joints  Qa  and  Qi,  are  revolute  or  prismatic  joints  each  having  one  degree  of  freedom, 
/c.  =  /Ck  =  1  •  These  equations  have  to  be  numerically  solved.  However,  in  the 
most  advantageous  case  the  number  of  dependent  joint  coordinates  in  the  character¬ 
istic  pair  of  joints  is  five  and  the  implicit  core  system  consists  of  only  one  equation 
which  can  be  explicitly  solved. 

There  are  6  -  h  additional  equations 

Scomp  (^/lar’^comp’S)  ^ 
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lower  segment 


XI 


Figure  7:  The  characteristic  pair  of  joints 


to  determine  the  6  —  h  “complementary”  joint  coordinates  belonging  to  the  pair 
of  joints  Sa  and  St  •  It  can  always  be  explicitly  solved  as  with  the  evaluation  of  the 
implicit  core  system  (21)  the  relative  position  of  the  bodies  within  both  segments  is 
known. 

4.2.  The  method  of  the  “Characteristic  Pair  of  Joints” 


4.2.1.  The  Characteristic  Loop  Closure  Parameters.  The  loop  closure  conditions  in 
Eq.  (21)  can  be  expressed  by  certain  distances  and  angles  -  the  “characteristic  loop 
closure  parameters”  -  measured  between  the  reference  frames  JCa  and  /Ci>  on  the  upper 
segment  and  AC*  and  Ka'  on  the  lower  segment.  These  loop  closure  parameters  can 
be  confined  to  five  fundamental  types  expressing  simple  geometric  relations  between 
points,  axes  or  planes  of  the  joints  Qa  and  Qt,.  In  the  following,  they  are  visualized 
by  corresponding  characteristic  pairs  of  joints. 

(I)  Distance  between  two  points  (Fig.  8a).  A  characteristic  pair  of  a  spherical 
joint  (5)  and  a  “reduced”  spherical  joint  (universal  joint,  Sr)  with  altogether 
h.  +  /e»  =  5  degrees  of  freedom  gives,  according  to  Eq.  (22),  h  =  1  closure 
parameter  gi  .  This  is  the  square  of  the  distance  d  of  the  centers  Oa  and  Oh  of 
the  joints  which  can  be  expressed  both  in  the  upper  segment  (left  index  u)  and 
in  the  lower  segment  (left  index  /): 

[9=Xa.h'  *  *  ^c,t'  “  ^u.t*  Ty.o  ,  (24) 
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Figure  8:  Implicit  loop  closure  conditions 


igi  =  •  »*«,«'  =  'rj.«  'ij..-  ,  ri.a.  =  r/,,.  -  r/.j  .  (25) 

Here,  the  dot  product  is  written  both  in  the  coordinate-free  vector  notation  and 
-  for  the  numerical  evaluation  -  in  matrix  notation  using  the  coordinates  of  the 
vectors  in  reference  frames  and  Ki  fixed  to  the  segments  (left  upper  indices 
u  and  /). 


(II)  Distance  of  a  Point  from  a  Plane  (Fig.  8b).  The  pair  of  a  planar  joint 
(E)  and  a  “reduced"  spherical  joint  (5h)  has  /p.  -i-  /p,  =  5  degrees  of  freedom 
and  requires  h  =  1  implicit  closure  parameter  gn  .  This  is  the  distance  d  of  the 
center  Ot,  of  the  reduced  spherical  joint  from  the  plane  n*  of  the  planar  joint: 


u9it  =  ■  Uj  =  “rjj,  "uj 

Wn  =  ri,a'  ■  u^’  =  -'rjo' 


(26) 

(27) 


(III)  Distance  of  a  Point  from  a  Line  (Fig.  8c).  For  a  pair  of  a  spherical  joint 
(S)  and  a  cylindric  joint  (C),  fg,  -J-  =  5,  the  characteristic  closure  parameter 

gin  is  the  square  of  the  distance  d  of  the  center  O*  of  the  spherical  joint  from 
the  joint  axis  Sj  of  the  cylindric  joint: 


”  Ha.b'  »  ^0,6'  —  ^ a.5'  ^  ^6'  * 

=  'rJ  ' 


Si.. 


i 

! 


I 

I 
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'■'‘f  -V-’ 


u^///  ^a,6'  ' 

tgin  =  ^6.3'  ■  n6.a' 


(28) 

(29) 


(IV)  and  V)  Dual  Angie  between  Two  Axes  (Fig.  8d.)  The  pair  of  two  cylindric 
joints  (C),  fe,  +  /cj  4,  requires  h  —2  closure  parameters  giv  and  gv.  The 
first  of  them  is  the  cosine  of  angle  a  between  the  two  axis  directions: 

uff/v  =  «<i  ■  tij'  =  “uj  “u*'  ,  (30) 

i9iv  =  Us  •  u«.  =  -'uj  .  (31) 


The  further  closure  parameter  gv  is  the  expression  dsina  with  the  shortest 
distance  d  between  the  lines  $«  and  $s  along  the  common  perpendicular: 

ugv  =  na.s.  •  f*a,s-  =  “ujy  “r,  j.  ,  n«.s.  =  l:,  X  Us.  ,  (32) 

igv  =  ns,«.  •  rs,,.  =  'nj,.  ‘rs...  ,  ns...  =  us  x  u»'  •  (33) 

4.2.2.  Systematics  of  the  Loop  Closure  Equations.  Generally,  the  loop  closure  equa¬ 

tions  can  be  stated  in  four  steps  which  are  summarized  in  the  following. 


P:  Prismatic  joint  S:  Spherical  joint  C:  Cylindric  joint  E:  Planar  joint 


Sk  '.  Two  revolute  joints  with  concurrent  axes 
Efi'-  Two  revolute  joints  with  parallel  axes  or  one  revolute 
and  one  prismatic  joint  with  orthogonal  axes 
Ep:  One  revolute  and  one  prismatic  joint  with  orthogonal  axes 
or  two  prismatic  joints  with  non-parallel  axes 


Table  1:  Implicit  loop  closure  conditions 


1 


Step  1  Choice  of  the  Characteristic  Pair  of  Joints.  Two  kinematic  pairs  having  | 

joint  coordinates  belonging  to  the  dependent  coordinates  0  of  the  multibody-  ! 

loop  are  chosen  as  a  characteristic  pair  of  joints.  The  possible  combinations  are  ^ 

shown  in  Table  1.  The  two  joints  are  chosen  in  such  manner  that  the  number  h 
of  implicit  equations  is  as  low  as  possible.  If  there  are  different  numbers  and 
fti  of  joints  coordinates,  the  joint  with  the  higher  number  of  joint  coordinates 
is  designated  by  ^«.  With  the  maximum  number  of  joint  coordinates  in  the  t 

characteristic  pair  of  joints  being  A  =  5,  the  highest  number  fg^  and  fg^  are  ■ 

three  and  two,  respectively. 

Step  2  Implicit  Loop  Closure  Equations.  The  A  implicit  loop  closure  equations 
(21)  have  the  general  form: 


iehar  (tieW’S)  ~ 

Here,  uffi  and  are  closure  parameters  chosen  from  the  five  elementary  types 
of  Eqs.  (24)  to  (33).  The  number  A  and  the  type  of  the  implicit  equations 
depend  on  the  type  of  the  two  joints  Qt  and  and  are  shown  in  Table  1. 
Having  evaluated  Eq.  (34'^  the  joint  coordinates  within  the  upper  and  the  lower 
segment  are  known.  Then,  the  direct  transitions  between  the  reference  frames 
Fa  and  on  the  upper  segment  and  XJs  and  /Ca<  on  the  lower  segment  can  be 
expressed: 


9liCh(tr 

19\  -  u9i 

9htCh%r 

.  t9k  -  u9li  . 

=a 


(34) 


‘X  -  “r„  J  ,  (35) 

^Ra.='’R,‘Ra'  ,  ‘ft  ('r,,.,  - 'r,  J  .  (36) 


To  determine  the  remaining  joint  coordinates  of  joints  Qa  and  Qi  the  relative 
position  of  the  two  segments  has  to  be  considered  which  has  been  not  yet  used 
up  to  this  step. 

Step  3  Joint  Coordinates  of  Joint  Qi,.  The  two  segments  are  built  together  in 
such  manner  that  the  corresponding  geometric  elements  of  the  two  joints  Qa 
and  Qi  on  the  upper  and  the  lower  segment  do  coincide.  With  respect  to  the 
different  joint  types  one  obtains  constraint  equations  for  the  maximal  two  joint 
coordinates  of  the  joint  Qi  (Woernle  1988).  For  this,  the  already  computed 
transitions  (35)  and  (36)  and  the  constant  dimensions  of  the  bodies  in  joint 
Qi  are  used.  One  obtains  the  matrices  ^'ft  and  describing  the  transition 


!33 


from  K.V  to  Kt,.  Together  with  Eqs.  (35)  and  (36)  the  resative  position  of  the 
reference  frames  AC**  and  ACa  of  joint  ACa  can  be  expressed: 

*ila-  =  “ili- ‘'il* ‘iia'  ,  (37) 

‘ta..'  =  ‘-R*'C‘ra.6'+%6  +  ''H*‘!:i..')  ■  (38) 

Step  4  Joint  Coordinates  of  Joint  Q^.  With  known  relative  position  of  reference 
frames  ACa<  and  ACa  the  joint  coordinates  of  can  be  determined  using  construnt 

equations  which  depend  only  on  the  type  of  joint  (Woemle  1988). 

The  cases  which  lead  to  closed-form  solutions  represent  the  class  of  recursively 
solvable  multibody  loops.  Such  cases  are  encountered  very  often  in  technical  applies* 
tions  of  complex  multibody  systems  and  are  thus  of  great  interest.  For  a  more  detailed 
description  of  this  method  the  reader  is  refered  to  the  more  elaborate  expositions  of 
Hiller  1986,  Hiller  and  Woernle  1988  and  Woerait  1988  (see  Section  4.4). 

4.3.  Method  or  the  “Minimal  Polynomiai.  Equation' 

This  method  can  be  regarded  as  an  extension  of  the  above  .i.entioned  method  of 
the  characteristic  pair  of  joints.  The  idea  is  to  state  the  constraiul  equations  for 
all  possible  joint  configurations  in  a  recursive  form,  whereby  for  the  first  unknown 
joint  coordinate  a  polynomiai  of  minimal  order  has  to  be  derived.  In  the  case  of 
only  rotational  coordinates  the  polynomial  is  stated  in  tan^  and  the  order  of  the 
polynomial  is  dependent  on  the  geometry  as  well  as  on  the  type  and  combination  of 
joint  coordinates.  If  the  kinematic  loop  consists  of  six  arbitrarily  arranged  revolute 
joints  (this  represents  the  “worst  case”),  the  minimal  order  of  the  polynomial  is  16. 

Dependent  on  the  type  of  the  unknown  joints  as  well  as  on  their  arrangement,  the 
order  of  ‘he  polynomial  equation  may  vary  between  16  and  2.  All  possible  combi¬ 
nations  together  with  the  order  of  the  polynomial  equation  (which  is  equal  to  the 
number  of  possible  configurations)  is  shewn  in  Table  2.  In  comparison  to  the  method 
of  the  “characteristic  pair  of  joints",  some  additional  geometrical  conditions  have  to 
be  stated.  This  method  was  first  developed  by  Lee  and  Liang  1988  and  has  been 
elaborated  in  Lee  et  al.  1991.  Further  improvements  are  given  in  Raghavan  and  Roth 
1990. 

The  principal  idea  behind  the  method  of  minimal  polynomial  equations  is  to 
state  an  appropriate  set  of  closure  equations  from  which  the  unknown  joint  angles 
can  be  algebraically  eliminated  in  such  a  way,  that  the  degree  of  the  final  polynomial 
equation  becomes  not  higher  than  16.  The  method  developed  by  Lee  and  Liang  uses  a  ■ 

two-step  elimination  of  four  unknown  angles  from  a  set  of  14  loop  closure  equations 
containing  five  unknown  joint  angles.  The  complete  elimination  process  described  f 

in  (Li  1991)  gives  the  following  calculation  scheme  for  the  arbitrarily  arranged  six 
unknown  joint  angles  (g  is  a  vector  containing  further  parameters): 

f  i/.(2)tan’^=0  (39) 
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Order  of 
polynomial 

Mechanisms 

R-3C 

RCCC 

2R-2S 

RSSR 

2R-P-C 

RCPCR,  RRCPC 

RCPRC,  RCRPC,  RPCRC 

RRPCC,  RPCCR 

RPRCC 

2 

3R-2P-C 

RPCPRR 

RPRPCR,  RRPRPC 

RPRPRC 

RCPPRR,  RRRPPC,  RPPCRR 

RRPPRC,  RCRPPR,  RPPRRC 

RPRCPR,  RPRRPC 

4R.3P 

RRPPPRR,  RPPPRRR 

RPRPPRR,  RRPRPPR 

RPPRRPR 

RPRPRPR 

4R-S 

RRSRR,  RSRRR 

4 

4R-E 

RRERR,  RERRR 

RCRCR,  RRCRC 

3R.2r 

rcrrC 

RCCRR.RRRCC 

8 

4R-P-C 

RRRPCR,  RRCPRR 

RRRRPC,  RPCRRR 

RCRPRR,  RRCRPR,  RRRPRC 

RCRRPR,  RRPRRC 

5R-2P 

RRPRPRR,  RRRPRPR 

RPRRPRR,  RPRRRPR 

RRRRPPR,  RRRPPRR 

5R-C 

RRRRCR,  RRRCRRR.  RRRRRC 

16 

6R-P 

RRRPRRR,  RRRRPRR.  RRRRRPR 

7R 

RRRRRRR 

P:  Prismatic  joint  S 

Spherical  joint  C:  Cylindric  joint  E:  Planar  joint 

Table  2:  Types  of  single-loop  mechanisms. 
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/Jj  =  /32(p,/3,  ) 

06  =  06{l,0l) 

0*  ~  ( £,/?!. 

03  =  03(^P,  01, 01, 06, 04^) 

06  ~  06  {^2_,  0\  ,  01 , 06 , 04 , 03^) 

4.4.  Automatic  Generation  or  Closed-Form  Solutions 


(40) 

(41) 

(42) 

(43) 

(44) 


As  shown  in  Table  2,  closed-form  solutions  are  always  possible  if  the  order  of  the 
minimal  polynomial  equations  equals  two.  By  a  suitable  combination  of  the  geomet¬ 
rically  intuitive  approach  of  the  characteristic  pair  of  joints  with  algebraic  techniques 
known  from  robotics  (Paul  1986),  it  is  possible  to  derive  an  algorithm  for  the  auto¬ 
matic  determination  of  closed-form  solutions  of  the  inverse  kinematics  problem  for 
loops  in  which  such  solutions  exist.  Such  an  approach  was  recently  developed  by 
Kecskemethy,  and  published  in  Kecskemethy  and  Hiller  1992.  In  the  sequel,  the 
main  ideas  of  this  approach  are  described. 

One  considers  a  single  closed  multibody  loop  modelled  as  a  sequence  of  homoge¬ 
neous  transformations  A< ,  i  =  1 , . . . ,  n  (Fig.  9). 


Figure  9:  Basic  structure  of  a  loop 

Recall  that  a  homogeneous  transformation  A,-  models  the  motion'from  a  reference 
frame  AC,_i  to  a  reference  frame  K,  ,  expressed  as  the  transformation  of  point 
coordinates  defined  with  respect  to  K,  to  corresponding  coordinates  with  respect  to 


-A  «*><./**'*•*• 


fC,-i  .  Such  a  transformation  matrix  has  the  structure 


A,  = 


■  Pu 

P\2 

Pl3 

r\  ■ 

•-1- 

l-liu 

Pji 

P22 

P23 

r2 

0 

1 

P31 

P32 

P33 

r3 

0 

0 

0 

1  . 

(45) 


where  is  the  orthogonal  3x3  matrix  of  rotation  transforming  vector  components 
from  AC,  to  ACi_i  and  lZ}r,  is  the  radius  vector  connecting  the  origin  0,-1  of  AC,_i 
to  the  origin  O,  of  AC,-  in  the  decomposition  with  respect  to  AC,_i  (the  indices  t 
and  i  -  1  have  been  left  out  in  coefficient-wise  notation  for  better  clarity). 

The  closure  of  the  loop  is  achieved  by  stating  AC„  =  ACo  ,  or,  equivalently 


I 

t 


i 

( 

i 


A)  Aj  •  ■  •  An  =  •  (46) 

Eq.  (46)  contains  twelfe  non-trivial  scalar  equations  to  be  fulfilied  for  the  loop  to  stay 
closed.  Out  of  these,  six  are  dependent  because  of  the  orthogonality  condition  of  the 
rotation  matrix.  However,  just  striking  out  six  equations  is  not  feasible,  because  then 
(a)  not  all  uniqueness  conditions  of  the  solutions  can  be  fulfilled,  and  (b)  closed-form 
solutions  will  not  become  evident. 

Actually,  in  order  to  find  closed-form  solutions  even  more  equations  have  to  be 
taken  into  account  by  considering  also  alternative  forms  of  the  closure  condition 
Eq.  (46),  such  as 


‘•>+1 


A.*  =A;:‘ 


A“*  A-‘ 


A-* 


(47) 


where  1  <  j  <  i  <  n  and  tj ,  . . . ,  is  a  cyclic  permutation  of  I ,  . . .  ,  n.  These 
equations  state  that  any  two  possible  branches  within  the  loop  starting  at  an  arbitrary 
reference  frame  AC,j  and  terminating  at  another  arbitrary  AC^^,  must  yield  the  same 
transformation. 

The  key  issue  of  an  algorithm  for  finding  closed-form  solution  is  thus  to  pick  out 
from  Equations  (46)  and  (47)  a  set  of  six  scalar  equations 


/i(/7i)  =  0 
h  (02 0i)  —  0 

f6{06',  0i,  ,  0\)  =  0 


(plus  some  additional  equations  needed  for  unique  solutions  where  possible)  with 
functions  /,  containing  exactly  one  unknown  more  than  the  preceding  equations  and 
being  mostly  of  order  two  in  the  corresponding  unknown  variable  0,  (or  tan  ^  in  the 
case  of  a  revolute  joint). 

This  problem  can  be  .solved  by  resorting  to  the  geometrical  properties  of  the 
transformation  matrices  A,,  in  particular,  of  their  invariance  properties.  We  introduce 
as  objects  of  interest  the  three  coordinate  planes  and  the  origin  of  the  reference 
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systems,  respectively.  These  geometrical  objects  have  the  following  representations 
.  homogeneous  vectors 


(49) 


where  the  symbol  ‘s’  is  stacked  above  homogeneous  vectors  for  better  clarity  (but 
will  be  dropped  later  when  there  is  no  risk  of  confusion  between  homogeneous  and 
euclidian  vectors)  and  the  vectors  c,-  are  particular  instances  of  unit  vectors  J ,  Op 
representing  the  points  at  infinity  of  the  projective  space  P„  (Bottema  and  Roth 
1970).  Note  that  the  following  properties  hold 
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A-‘A  =  , 

=  (A'ri)^  =  (A-‘I)^  , 

where  ||  •  ||b  denotes  the  “homogeneous  norm” 
||Ali|B  =  ||A->E||H. 


(50) 

(51) 

(52) 

(53) 


The  transformations  A,-  can  be  divided  into  elementary,  general  and  trivial  trans¬ 
formations.  The  elementary  transformations 
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are  denoted  as  A£:(e, ;  /J) ,  translational  and  rotational  transformations  being  distin¬ 
guished  by  a  boolean  variable  a  which  is  1  in  the  first  case  and  0  in  the  second,  and 
for  which  a  —  \  —  <t  .  Recall  that  these  transformations  form  a  basis  for  the  group 
of  rigid  rotations,  so  that  any  rigid-body  motion  can  be  decomposed  into  a  sequence 
of  six  such  transformations.  For  the  general  transformations,  the  sub-types  general 
translational  (At  ),  general  rotational  (Ajt )  and  general  spatial  (Ac  )  motion 


At  = 


I3  L 

■  R  Q  ' 

R  r 

0  1 

,  Ah  = 

0  1 

,  Ac  = 

0  I 

(54) 


are  taken  into  account.  Finally,  there  exist  24  trivial  transformations  which  just 
interchange  the  coordinate  axes  (and  thus  involve  no  numerical  computations).  These 
can  be  collected  with  the  notation 


Ap  =  Perm (i,,  12,13]  ,  (55) 

where  the  coefficients  of  the  rotation  part  of  Ap  fulfill  the  relationships 

f+1  for  ij  =  k 

-1  for  ij  =  ~k  (56) 

0  otherwise 


We  now  assume  that  the  sequence  of  transformations  within  the  loop  is  such  that 
the  unknown  variables  only  appear  in  elementary  transformations,  and  that  all  trivial 
transformations  have  been  eliminated.  This  can  be  always  achieved  by  reducing  com¬ 
posite  transformations,  such  as  the  four-parametric  DENAVIT-HARTENBERG-form, 
into  elementary  transformations,  and  shifting  trivial  transformations  to  the  left  or 
to  the  right  (Kecskemethy  and  Hiller  1992).  the  key  idea  of  the  algorithm  is  now 
to  regard  the  characteristic  measurements  within  the  loop  as  particular  projection 
operations,  and  to  search  the  sequences  of  transformations  for  sub-sequences  which 
leave  some  geometric  elements  invariant.  This  is  explained  in  the  sequel. 

4.4.1.  Projection  Operators.  Projection  operators  represent  the  basic  means  of  ob¬ 
taining  scalar  equations  from  the  general  closure  condition  Eq.  (46).  As  general  cri¬ 
teria,  projection  operators  should  not  be  any  linear  combination  of  the  invariants  of  a 
4x4  matrix,  and  should  yield  as  simple  expressions  as  possible  in  order  to  allow  the 
closed-form  resolution  for  any  unknowns  contained  in  the  projected  matrix.  In  order 
to  achieve  this,  projection  operators  are  lead  back  to  the  basic  geometrical  measure¬ 
ments  used  in  kinematics.  Currently,  five  such  basic  measurements  are  being  used* : 
(I)  the  quadratic  distance  between  two  points  gpp  ,  (II)  the  distance  of  a  point  to  a 

‘Recently,  a  sixth  measurement  type  was  introduced  in  Leu  and  Liang  1988.  which  can  be  in¬ 
terpreted  as  the  projection  of  the  orientation  vector  of  a  line  with  the  reflection  of  the  orientation 
vector  of  a  second  line  about  the  plane  perpendicular  to  the  vector  connecting  one  reference  point 
on  each  line,  see  also  Angeles  and  Zanganeh  1992.  The  incorporation  of  this  measurement  type  in 
the  general  theory  is  subject  of  future  research. 


139 


plane  qep  ,  (III)  the  cosine  of  the  angle  between  two  planes  (or  orientations)  p££, 
(IV)  the  distance  (along  the  common  perpendicular)  between  two  lines  qll  and  (V) 
the  quadratic  distance  of  a  point  to  a  line  gip,  see  e.g.  Woernle  1988  or  Hiller  and 
Kecskemethy  1989.  In  order  to  carry  out  these  measurements  using  homogeneous 
transformations,  two  reference  frames  K  (fixed)  and  K.'  (moved)  are  introduced,  such 
that  the  points,  lines  or  planes  mentioned  above  correspond  with  either  an  origin 
o ,  a  coordinate  axis  C,  or  a  coordinate  plane  H,- ,  respectively.  Denote  by  A  the 
homogeneous  matrix  relating  coordinates  with  respect  to  1C'  to  coordinates  with  re¬ 
spect  to  tC.  Then,  the  measurements  mentioned  above  define  the  following  projection 
operations 

9pp{A)  =  HA  5  III  (57) 

9Ep(A-,ei)  =  if  Ao  (=r,(A) )  (58) 

9EE{A\ti,^j)  =  I,  A  I,  {=Pi}iA))  (59) 

9u{A\e„s!,)  =  ej  [Rot{A)e'  xTrans[A]]  (=  e.w  •  ^itj(A)  •  r,(A)  )  (60) 

9Lp{A-,e,)  =  IIAo  III -(if  Afi)*  (61) 


Note  that  for  the  projections  ggp  or  gip  the  corresponding  plane  or  line  is  chosen 
from  the  fixed  frame.  This  is  consistenv.  with  the  property  that  premultiplication  of 
homogeneous  matrices  is  only  meaningful  for  orientation  vectors.  Resolution  of  the 
projected  matrix  with  respect  to  an  unknown  joint-coordinate  0  contained  in  A  is 
obtained  by  decomposing 

A=ArAE(e,;/3)A.=  ^  Re{^;  0)  r£(e,;/3)  ^  r, 

where  A£(e„ ;  0)  is  an  elementary  transformation  with 

Re{^u\0)  =  /3  +  ff(sin/3  e„ -1-(1 -cos/?)  = /a  +  ar(^  ; /?)  (63) 

r£(c„;/3)  =  (Te^0  (64) 

and  u  denotes  the  anti-symmetrical  matrix 

/  0  -U3  V2  \ 

U=  V3  0  -Ui 

V  -V2  Vi  0  / 

Note  that  all  projection  types  can  be  described  by  a  general  projection  operator 
A)i  €  {o,jC,,n,}  denote  a  “left”  and  a  “right”  geometrical 

element,  between  which  the  measurement  is  carried  out.  Table  3  shows  the  actual 
projections  which  are  performed  in  each  case. 


in 

0 

n. 

c, 

H 

9Pp{^) 

9Ep{Ar^ :  Uj ) 

9lp(A-^;Uj) 

□ 

9Ep(^  ;  u, ) 

9ee(A  ;  Ki ,  a, ) 

none 

Q 

9Lp{A-,u,) 

none 

9Lii{A  ;  Ui ,  u J 

Table  3;  Definition  of  the  general  projection  operator ’t  ( ;  A ) 


4.4.2.  Use  of  Isotropy  Groups  for  Elimination  of  Unknowns.  If  one  can  find  a  se¬ 
quence  of  transformations  which  leaves  geometric  element  invariant,  it  is  clear  that 
any  projection  involving  that  geometric  elements  will  be  independent  of  the  vari¬ 
ables  contained  in  that  sequence.  The  characteristic  properties  of  such  sequences  of 
transformations  can  be  quickly  recollected  as  those  of  particular  subgroups  of  the 
group  of  general  rigid  motion,  namely  the  isotropy  groups  of  the  geometric  elements 
in  question. 

Let  <7  be  a  group  acting  on  a  smooth  manifold  M.  For  each  x  €  M,  the  isotropy 
group  is  defined  to  be  G*  =  {  ir  €  G :  yx  =  i  }  (cf.  Olver  1986).  The  isotropy  groups 
of  interest  in  the  formulation  of  constraints  are  the  subgroups  of  rigid  motion  which 
leave  the  origin,  the  coordinate  planes  and  the  coordinate  axes  invariant,  respectively, 
i.e.  the  sets 


=  {  A:  A^  =  ^}  ,  ^€{o,n.-,£.  }  .  (65) 

Denote  by  a  particular  element  of  an  isotropy  group,  where  the  super¬ 

script  (()  will  be  dropped  when  not  needed.  The  following  three  group  properties  are 
an  immediate  consequence  of  the  definition  of  isotropy  groups 

(IGl) 

(IG2)  A«>  e  44.  A«>’‘  G 

(IG3)  A^>  e  A”''’  A  A«>  €  A“"’  =>  A«>  Af  e  A""'' . 

Particularly  because  of  property  (IG3),  the  detection  of  subsequences  of  transforma¬ 
tions  which  leave  a  geometric  element  invariant  is  very  simple,  namely  just  a  gathering 
of  adjacent  transformations  with  this  property.  Suppose  that  one  has  found  two  non¬ 
overlapping  subsequences  and  Ag  with  respective  invariant  geometric  elements 
and  and  that  both  of  these  contain  as  much  elements  and  as  much  unknowns 
as  possible  among  all  possible  sequences  of  transformations,  whereby  Ag  contains  a 


/ if  *«/  f  \ 


*  V 
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smaller  or  equal  number  of  unknowns  than  A^.  After  appropriate  cyclic  permutation, 
the  closure  condition  can  be  transformed  into  the  unique  form 


A/  Ab  All  kA  =  I*  ,  (Closure  Type  0) 

which  can  be  immediately  transformed  into 
Afl  All  Aa  =  A7*  . 


(66) 


(67) 


Then,  because  Aa  leaves  invariant,  and  Ab  leaves  invariant,  the  projection  op¬ 
erator  Ab  All  Ayi )  will  be  invariant  of  both  A^  and  Ab-  Thus,  applying 

this  projection  on  Eq.  (67)  yields  the  scalar  equation 


(68) 


which  is  independent  of  all  variables  contained  in  A  a  as  well  as  in  Ab-  Clearly, 
if  all  but  one  of  the  current  unknowns  are  contained  in  A^  or  As,  then  either  A/ 
or  Alt  contains  exactly  one  unknown  variable,  and  after  decomposing  according  to 
Eq.  (62)  and  applying  the  projection  operator  selected  by  and  (g,  a  resolvable 
scalar  equation  results.  Eq.  (67)  corrnponds  to  the  division  of  the  loop  in  four  sub¬ 
chains  (Figure  10),  of  which  Ab  and  Ax  have  no  inBuence  on  the  projected  equation. 
This  division  can  also  be  used  for  the  efficient  formulation  of  the  Jacobian  of  the 
loop.  It  is  conjectured  that  this  division  is  optimal  in  this  sense. 


Figure  10:  Qualitative  structure  of  a  loop  for  the  “optimal”  division 

In  principle,  after  finding  a  first  closure  condition  with  the  properties  discussed 
above,  the  remaining  unknowns  can  be  resolved  in  a  straight-forward  manner  using 
existing  algorithms.  However,  by  a  slight  modification  of  expectable  closure  condi¬ 
tions,  the  same  basic  steps  can  be  applied  for  all  unknowns  in  the  loop  and  even 
in  the  case  of  some  overconstrained  mechanisms,  which  are  not  paradoxical  in  the 
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sense  defined  in  Angeles  1988.  Then,  at  any  stage  of  the  analysis,  besides  the  closure 
condition  denominated  Type  0  above,  only  one  of  the  following  situations  can  arise: 


=  l4  (Closure  Type  1)  (69) 

As  A^  =  I4  (Closure  Type  2)  (70) 

A/AbA/;Aa  =  I4  (Closure  Type  3)  (71) 

A/Aa  =  I4  (Closure  Type  4)  (72) 


Clearly,  in  the  first  of  these  cases  the  whole  sequence  of  transformations  in  the  loop 
is  element  of  the  isotropy  group  of  some  geometric  element  Thus,  any  projection 
carried  out  with  this  element  yields  a  scalar  equation  which  is  identically  fulfilled.  As 
there  are  three  independent  projections  which  can  be  carried  out  with  one  geometric 
element,  a  closure  condition  of  Type  1  reduces  the  number  of  independent  constraint 
equations  of  the  loop  by  three.  For  example,  in  the  plane  four-bar  mechanism  all 
transformations  share  as  invariant  element  the  plane  perpendicular  to  the  rotation 
axes,  so  the  number  of  independent  constraint  equations  is  here  only  three.  Similarly, 
in  the  closure  condition  of  Type  2  the  chain  is  decomposed  into  two  sequences  which 
contain  together  ail  unknowns  and  are  elements  of  the  isotropy  groups  of  geometric 
elements  and  (g,  respectively.  Thus  the  projection  operator  selected  by  these 
two  elements  yields  again  a  scalar  equation  which  is  independent  of  any  unknown 
variables.  Such  a  situation  arises  for  example  in  the  case  of  a  Cardan  shaft,  where  the 
six  rotational  joints  can  be  grouped  into  two  sets  of  respectively  three  intersecting  axes 
with  the  intersection  points  as  corresponding  invariant  geometric  elements.  Note  that 
for  these  two  types  of  closure  conditions,  the  sequences  A^  or  Ag  may  be  bordered 
with  additional  transformations  containing  no  unknowns  without  changing  the  basic 
results.  Such  bordering  transformations  have  been  intentionally  left  out  for  better 
clarity. 

The  closure  conditions  of  Type  3  zmd  Type  4  do  not  occur  in  the  initial  analysis 
of  the  loop,  but  in  the  process  of  eliminating  unknowns  contained  in  the  sequences 
Ab  and  Aa.  The  present  algorithmic  approach  for  obtaining  scalar  equations  for 
these  unknowns  is  as  follows:  after  having  produced  the  projection  pertaining  to  ^g 
and  the  invariance  property  associated  with  ^g  is  removed  from  the  elements 
of  Afl  together  with  the  current  resolved  unknown.  Then,  a  new  closure  condition 
is  searched  by  applying  the  same  criteria  as  above.  Eventually,  no  more  invariant 
properties  remain  besides  those  in  A^t,  but  there  is  still  an  unknown  in  the  remaining 
transformations.  This  is  the  situation  in  the  closure  condition  of  Type  3,  where  As 
contains  the  remaining  unknown  in  a  form  similar  to  Eq.  (62).  Then,  a  similar  projec¬ 
tion  as  Eq.  (68)  is  carried  out,  but  this  time,  (g  is  taken  as  a  geometric  element  which 
actually  is  transformed  by  Ag,  thus  yielding  a  scalar  equation  which  contains  this 
unknown.  In  the  case  that  Ag  is  a  rotation,  these  elements  correspond  to  both  coor¬ 
dinate  planes  parallel  to  the  rotational  axis  and  a  uniquely  solvable  pair  of  equations 
is  obtained.  After  nerforming  this  step,  the  invariance  properties  of  are  removed 


from  the  elements  in  Ay*,  and  the  whole  process  described  above  is  repeated,  until 
eventually  one  unknown  is  pending,  but  no  invariant  element  remains  whatever.  This 
is  the  situation  of  closure  condition  Type  4.  where  Ay*  holds  the  remaining  unknown. 
Then,  again  a  similar  projection  as  Eq.  (68)  is  carried  out,  but  this  time  (g  and 
are  taken  as  geometrical  elements  which  are  actually  transformed  by  A,*,  yielding  as 
in  the  case  of  the  closure  condition  of  Type  3  a  unique  solution. 

A  description  of  an  implementation  of  this  method  has  been  given  in  Kecskemethy 
and  Hiller  1992.  Further,  an  application  of  the  generation  of  closed-form  solutions  to 
the  automatic  programming  of  high-speed  processors,  like  the  “CORDIC”  (Coordi¬ 
nate  Digital  Computer)  has  been  worked  out  in  Risse  1992. 

5.  Kinematics  of  multiloop  systems 

5.1.  The  Concept  of  the  “Kinematical  Transformer” 

For  the  following  it  will  suffice  to  note  that  the  relative  kinematics  of  a  multibody  loop 
can  be  reduced  to  a  system  of  equations  which  yield  six  dependent  joint  coordinates 
as  functions  of  /  (Li)  independent  joint  coordinates  as  shown  in  the  previous  section. 
After  the  appropriate  formulation  of  the  constraint  equations  these  functions  can 
be  regarded  as  producing  a  nonlinear  transmission  behaviour  between  independent 
“input”  variables  and  dependent  “output”  variables.  This  is  represented  in  Fig.  11 
by  a  “black  box”  called  kinematical  transformer,  where  for  better  clarity  the  loop 
index  Li  is  dropped  and  independent  joint  coordinates  are  denoted  q.  With  these 
transmission  elements,  the  constraint  equations  of  general  multibody  systems  can  be 
systematically  partitioned  into  small  subsystems,  allowing  one  to  find  closed-form 
solutions  for  the  constraints  of  systems  with  multiple  multibody  loops  as  easily  as  for 
single-loop  systems,  where  this  is  possible. 

5.2.  Assembly  of  Kinematical  Transformers 

In  a  general  multibody  system  it  is  possible  to  define  a  fundamental  system  of 
multibody  loops,  which  correspond  to  the  fundamental  cycles  of  the  associated  graph 
of  interconnection.  To  take  advantage  of  this  property,  one  regards  th  multibody 
system  as  a  muUiloop  system:  introducing  appropriate  joint  coordinates,  and  formu¬ 
lating  the  constraint  equations  of  each  multibody  loop  individually,  yields  a  set  of 
''kinematical  transformers”  which  are  in  a  first  step  independent.  Clearly,  the  com¬ 
plete  set  of  joint  coordinates  introduced  to  describe  each  individual  multibody  loop 
as  a  “kinematical  transformer”  leads  to  a  redundant  set  of  joint  coordinates.  Thus 
additional  conditions  have  to  be  formulated  in  order  to  make  the  complete  set  of 
variables  0  consistent.  These  consistency  conditions  will  define  the  interconnection 
of  the  individual  transmission  elements,  as  shown  in  the  following. 

Consider  a  joint  Qi,  contained  in  nc  (jointi)  loops,  and  connecting  na  (Qt)  bodies, 
see  Fig.  12.  The  relative  position  of  the  bodies  6f’, . . . ,  bngie,)  connected  by  the  joint 
can  be  described  by  a  unique  joint  coordinate  pj  for  each  body  6,.  as  measured 


! 
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Figure  11:  The  general  kinematical  transformer 

from  one  of  the  bodies,  say  body  6j.  Within  each  loop  i*  incident  with  joint  an 
additional  joint  coordinate  0^',  describing  the  relative  position  between  two  bodies 
bi^^k)  and  bini,),  is  introduced.  Thus  the  following  relationships  hold  at  the  joint: 

fii  =  0  ,  (73) 

f:=\,...,n[,(gi)  ,  (74) 

where  a^'  represent  some  constants.  This  is  a  system  of  nt(^,)  +  1  linear  equations 
which  can  be  put  into  the  compact  matrix  notation 

=  0<'’  +  of'  , 


with 


0  = 

Pi 

II 

0 

fit 

:a^*  = 

■  0 
of' 

.  PnatC.)  . 

.  ^nLiC.)  . 

.  “"tlP.)  . 

(75) 


(76) 


Clearly,  for  the  (ni,(Qi)  +  1)  x  nB(Qi)  matrix  P^'  having  general  rank  r^‘,  with 

(^i)  •  <  nt(G)  +  1  .  (77) 
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Figure  12:  A  joint  connecting  several  bodies 
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Eq.  (75)  only  has  a  solution  if  ^  satisfies  ni(G)  +  1  -  linear  equations 


where,  after  appropriate  column  pivoting  of  matrix  the  (n/,(C;)  + 1  -r®-)  x  ndG) 
matrix  K®'  will  contain  only  zeros  and  ±1. 

A  case  of  particular  interest  is  obtained  if  the  matrix  P^'  has  full  column  rank, 


In  this  case  the  number  of  independent  linear  equations  in  Eq.  (78)  is 


(79) 


p(Qx)  —  nt  (Qi)  -  TiB  (Q,)  +  1 


(80) 


and  the  number  of  intercornections  between  the  loops  can  be  established  very  easily 
at  each  joint.  If  Eq.  (79)  holds  for  all  joints  the  multibody  system  is  said  to 
be  completely  loop-connected.  This  is  the  case  if  every  body  belongs  to  a  loop,  and 
every  loop  has  at  least  one  body  in  common  with  another  loop.  Complex  multibody 
systems,  or  at  least  subsystems  of  complex  inultibody  systems,  typically  belong  to 
this  category. 

Eq.  (78)  describes  the  independent  linear  relationships  which  hold  between  the 
joint  coordinates  of  the  individual  multibody  loops.  Clearly,  they  are  defined  uniquely 
at  each  joint  and  involve  only  signed  sums  of  joint  coordinates.  Thus  they  can  be 
represented  by  summ  ing  junctions  connecting  the  individual  kinematical  transformers 
in  a  block  diagram  designated  kinematical  network,  see  Fig.  13  below. 

It  is  easy  to  show  that  the  sum  of  the  local  degrees  of  freedom  of  the  multibody 
loops  reduced  by  the  sum  of  the  number  of  interconnection  equations  at  each 
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joint  p(Qi),  results  in  exactly  the  number  of  degrees  of  freedom  of  the  correspond¬ 
ing  multibody  system.  The  “assembled”  kinematical  transformers  thus  represent  an 
isomorphism  of  the  relative  kinematics  of  complex  multibody  systems  to  a  much  sim¬ 
pler  representation.  From  this  representation,  a  further  optimization  of  the  system 
of  constraint  equations  is  possible. 

5.3.  Determination  or  Equation  Ordering 

In  the  block  diagram  of  kinematical  transformers,  the  orientation  of  the  edges  rep¬ 
resents  the  sequence  in  which  the  individual  equations  are  solved.  An  aspect  of 
particular  interest  is  to  find  an  ordering  of  the  constraint  equations,  such  that  they 
are  recursively  solvable.  This  aim,  which  involves  also  the  choice  of  generalized  co¬ 
ordinates,  can  be  formulated  as  an  orientation  problem  in  the  block  diagram.  The 
conditions  for  recursive  solution  are: 

1.  The  number  of  external  inputs  is  equal  to  the  number  of  degrees  of  freedom  of 
the  system. 

2.  The  number  of  inputs  for  e2ich  multibody  loop  L,  is  equal  to  the  local  degree 
of  freedom  /(i,)  of  the  loop. 

3.  Each  summing  junction  has  exactly  one  output. 

4.  There  are  no  closed  circuits. 

5.  The  local  kinematics  of  the  transformers  are  recursively  solvable. 

The  analysis  of  complex  multibody  systems  shows  that  for  the  majority  of  tech¬ 
nical  applications  conditions  (1)  through  (5)  can  be  accomplished.  These  systems 
are  termed  recursively  solvable  systems.  Systems  for  which  not  ail  conditions  can  be 
fulfilled  are  called  non-recursively  solvable  systems.  The  most  common  reason  for  the 
appearance  of  a  non-recursively  solvable  system  is  that  conditions  (1)  through  (4) 
can  not  be  accomplished.  The  cases  for  which  condition  (5)  is  violated  are  very  rare 
and  shall  not  be  regarded  here. 

A  method  for  finding  an  orientation  of  the  edges  of  the  block  diagram  which  ful¬ 
fills  conditions  (1)  to  (4)  in  the  case  of  recursively  solvalbe  systems  is  proposed  in  < 

Hiller  and  Anantharaman  1989  and  Kecskemethy  1993a.  The  equation  ordering  can  ' 

be  found  very  easily  in  this  case  by  considering  the  degree  of  coupling  of  the  elements  ‘ 

(i.e.  the  number  of  edges  connecting  them  to  other  elements)  as  compared  with  the  | 

number  of  allowable  inputs:  steurting  from  unoriented  edges,  one  subsequently  orients 
the  edges  of  those  elements  (summing  junctions  or  transformers),  whose  number  of 
unoriented  edges  is  not  greater  than  the  number  of  allowable  inputs,  as  inputs.  .After 
orienting  all  edges,  the  block  diagram  now  also  contains  the  solution  flow  for  the  rel¬ 
ative  kinematics,  which  represents  the  required  ordering  of  the  constraint  equations. 


As  an  example  of  a  recursively  solvable  system,  a  planar  mechanism  consisting  of 
four  interconnected  planar  four-bar  loops  is  considered,  see  Fig.  13.  The  redundant 
set  of  relative  coordinates  includes  for  each  loop  four  variables.  Three  of  these  can 
be  solved  as  functions  of  the  fourth  in  closed  form,  yielding  corresponding  kinemat- 
ical  transformers.  There  are  three  linear  assembly  equations  occuring  in  the  joints 
A,  B ,  C  .  A  sequence  of  elements  for  which  unoriented  edges  can  be  oriented  as 
described  above  is:  1^,0 ,  L3,  Lj,  B ,  A,  Li  .  This  sequence  yields  a  “solution 
flow”  which  obviously  is  recursive.  Thus  the  constraint  equations  of  this  system  are 
solvable  in  closed  form. 
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Fijure  13:  A  recursively  solvable  system  and  its  corresponding  kinematical  network 


The  equation  ordering  for  the  non-recursive  case  is  more  difficult  to  optimize.  A 
possible  method  which  gives  good  results  is  to  first  remove  as  many  summing  junctions 
as  necessary  until  the  remaining  system  is  recursively  solvable.  This  momentarily 
increases  the  number  of  degrees  of  freedom,  so  additional  pseudo-inputs  £  have  to  be 
introduced.  The  linear  equations  which  correspond  to  the  removed  junctions  then 
define  implicitly  the  functions  £{£),  which  can  be  solved  numerically. 

An  example  of  a  non-recursively  solvable  system  is  shown  in  Fig.  14.  The  planar 
mechanism  consists  of  five  independent  multibody  loops  which  are  again  four-bar 
mechanisms.  There  are  four  linear  assembly  equations  at  the  joints  A,  B .  C ,  D 
From  the  corresponding  block  diagram  it  is  clear  that  the  algorithm  described  above 
can  not  start,  because  there  is  no  element  which  has  an  allowable  number  of  inputs 
greater  than  the  number  of  connections.  This  situation  changes  when  the  summing 
junction  D  is  removed  and  an  additional  input  q  is  provided.  In  this  ceise  the  system 
is  recursively  solvable.  The  original  system  .is  achieved  by  re-considering  the  closure 
condition  at  junction  D,  which  yields  the  implicit  equation  for  the  determination  of 
the  function  q[q). 
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a)  multibody  system  b)  kinemat^al  network 


Figure  14:  A  con-recursively  solvable  system  and  its  kinematical  network 

In  technical  applications  only  very  few,  if  any,  of  these  additional  implicit  equa¬ 
tions  occur.  As.  a  consequence,  the  number  of  implicity  defined  functions  is  sub¬ 
stantially  reduced,  and  the  kinematics,  as  well  as  the  dynamics,  can  be  solved  very 
efficiently. 

6.  Nonholonomic  Constraints 

Since  a  general  discussion  of  nonholonomic  constraints  is  beyond  the  scope  of  this 
paper,  it  seems  to  be  more  suitable  to  consider  the  rolling  wheel  as  a  typical  example 
of  nonholonomic  constraints.  It  is  part  of  the  roboTRAC  —  a  combined  wheeled 
and  legged  vehicle  —  which  can  be  modelled  as  a  complex  nonholonomic  multibody 
system  with  kinematical  loops  and  a  time-varying  structure  (see  Fig.  15).  Several 
investigations  (Hiller  and  Schmitz  1990,  Hiller  and  Schmitz  1991,  Hiller  et  al.  1990) 
dealt  with  the  formulation  of  the  kinematics  and  dynamics  as  well  as  the  generation 
of  walking  patterns  for  this  mobile  mechanical  platform. 

6.1.  Kinematical  Model 

In  this  chapter,  two  different  approaches  for  solving  the  nonholonomic  kinematics  of 
the  roboTRAC,  which  have  already  been  presented  in  detail  in  Hiller  and  Schmitz 
1990,  Hiller  et  al.  1990,  will  be  compared  and  discussed.  For  the  subsequent  investi¬ 
gation  the  following  assumptions  leading  to  the  kinematical  model  shown  in  Fig.  15 
hold; 

•  The  free  motion  of  the  carriage  will  be  described  by  six  coordinates  represented 
by  three  prismatic  joints  (3P)  for  the  translational  motion  and  by  three  revolute 
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Figure  15:  The  roboTRAC  (Werder  1988). 


joints  (3R)  for  the  rotational  motion  connecting  the  carriage  to  the  inertial 
frame. 

•  The  wheels  can  be  substituted  by  skids  which  do  not  influence  the  kinematical 
behaviour  of  the  system. 

•  Every  foot  tip  will  be  connected  to  the  environment  by  three  prismatic  joints 
(3P).  This  is  a  suitable  approach  to  control  the  walking  motion  of  the  roho- 
TRAC. 

Not  taking  into  account  the  nonholonomic  constraints  arising  from  the  skids,  the 
number  of  degrees  of  freedom  of  the  complete  holonomic  system  is 

A  =  12  . 

The  configuration  space  has  the  dimension  dim  C  =  12  (Neimark  and  Fufaev  1972). 
Due  to  the  two  nonholonomic  skid  conditions,  the  number  of  degrees  of  freedom  of 
the  complete  system  is  reduced  to 

/=10  , 

which  is  equal  to  the  dimension  dim  P  of  the  phase  space. 

6.2.  Constraint  Equations  of  Nonholonomic  Systems 

The  nonholonomic  constraints  in  a  nonholonomic  system  are  represented  hy  linear 
relations  between  velocities,  which  are  not  integrable.  Assume  a  nonholonomic  multi- 
hody  system  with  k  =  rp  holonomic  constraints  and  n  nonholonomic  constraints.  Let 
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the  dimension  of  the  configuration  space  C  he  m  =  np  —  h  while  the  dimension  of  the 
phase  space  P  is  /  =  m  —  n. 

The  holonomic  constraints  can  be  stated  as  a  set  of  nonlinear  algebraic  equations 

(^)=0  ,  i  =  ,  (81) 

where  0  is  the  np  x  1  vector  of  the  joint  coordinates.  Differentiating  Eq.  (81)  with 
respect  to  time  yields 

=  =  0  ,  (821 

with  Jh  as  the  hxnp  Jacobian  of  the  holonomic  system. 

Additionally,  the  nonholonomic  constraints  can  be  expressed  as 

Jnt=0  ,  (83) 
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where  is  the  nxnp  Jacobian  corresponding  to  the  nonholonomic  constraints.  Two 
procedures  to  solve  the  kinematics  of  a  nonholonomic  system  are  possible  (Fig.  16). 
On  the  one  hand,  all  n  +  constraint  equations  can  be  stated  on  velocity  level  as  a 
set  of  linear  equations;  the  corresponding  position  can  be  obtained  from  numerical 
integration  of  all  joint  velocities.  This  method  will  be  named  velocity  constraint 
method  (VCM).  On  the  other  hand,  all  h  holonomic  constraint  equations  can  be  stated 
on  position  level  as  a  set  of  highly  nonlinear  equations,  while  the  n  nonholonomic 
constraints  are  stated  as  a  set  of  linear  equations  on  velocity  level.  The  corresponding 
n  position  coordinates  can  be  obtained  from  numerical  integration.  This  method  will 
be  named  combined  constraint  method  (CCM). 

6.3.  Kinematics  of  the  roboTRAC 


In  this  section,  only  a  short  overview  of  both  methods  including  the  solution  procedure 
will  be  given.  A  more  detailed  description  can  be  found  in  Hiller  and  Schmitz  1990 
and  Hiller  et  al.  1990. 

6.3.1.  Velocity  Constraint  Method.  Considering  Fig.  17,  the  following  velocity-level 
equations  can  be  formulated  for  the  holonomic  constraints; 


•  The  velocities  of  the  foot  reference  points  7<,  t  =  1,2  relative  to  the  inertial 
frame  AC/  must  vanish: 


vt,  =  0 


1  =  1,2 


(84) 


•  The  projection  of  the  velocity  vectors  vsii  i  =  1,2  of  the  skids  onto  the  ground 
normal  vectors  n^;,  t  =  1.2  must  also  vanish: 


vs^  ■ns,=  0  .  i=  1.2 


(85) 
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Figure  16:  Constraints  of  nonholonomic  systems 


Figure  17:  Kinematical  model  of  the  roboTRAC 


U5.  •  («s.  X  ns.)  =  0  ,  1=1,2 


(87) 


Evaluating  Eqs.  (84)  -  (87)  using  forward  kinematics  yields 

J00  =  Q  ,  (88) 

where  Jg  represents  the  (12  x  22)  Jacobian  of  all  constraint  equations  and  d  is  a 
(22  X  1)  vector  containing  all  joint  velocities. 

After  choosing  /  =  10  velocities  out  of  d  as  independent  velocities  and  assembling 
them  into  the  vector  of  the  pseudo-velocities  the  remaining  12  velocities  8.  can 
be  obtained  by  solving  Eq.  (88).  To  get  the  joint  coordinates  of  the  complete  system 
at  each  time  step,  all  22  joint  velocities  have  to  be  integrated  numerically  (Fig.  18). 

6.3.2.  Combined  Constraint  Method.  In  this  method,  first  a  holonomic  system  with 
/  =  12  degrees  of  freedom  is  exhaustively  modelled  for  efficient  kinematics.  The  corre¬ 
sponding  constraint  equations  on  position  level  can  be  derived  using  the  characteristic 
pair  of  joints.  The  solution  flow  based  on  the  principle  of  kinematical  transformers 
becomes  obvious  from  Fig.  19.  In  this  figure.  La  and  Lb  represent  the  kinematical 
loops  between  the  inertial  frame  and  the  foot  points  T),  Tj,  while  Lc  and  Ld  repre¬ 
sent  the  kinematical  loops  between  the  inertial  frame  and  the  skid  reference  points 
Si,  Sj,  respectively. 


Figure  19:  Block  diagram  of  the  holonomic  system 
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Regarding  the  nonholonomic  system  in  a  second  step,  the  degrees  of  freedom  are 
reduced  from  twelve  to  ten  by  the  two  nonholonomic  skid  conditions.  Introducing 
the  independent  pseudo-velocities 

!  =  , 

the  two  dependent  velocities  qu  and  qi2  can  be  determined  from  Eq.  (87). 

For  this,  the  linear  nonholonomic  constraints  can  be  expressed  in  terms  of  the 
pseudo  velocities  t  and  the  unknown  velocities  fn  &nd  fi2. 


i=A 


9n  ^  Ci(ffi,...,jrio)  _q 
912  C2(ffi,...,fflo) 


Eq.  (89)  can  be  represented  by  the  following  block  diagram: 


2  relative 

— *  kinematics  ^ — ► 

2  (holonomic)  ^itp 


nonholonomic 

constraints 


The  still  unknown  matrix  A  and  vector  c  can  be  determined  by  evaluating  Eq.  (89) 
with  particular  inputs  as  described  in  Table  4. 


<711=912=0  ^  j  ^ 

ff  as  given  ^ 

<711  ®  coL-..  of  A 


9ii  =0,  9ij  —  1 

X  =  0 


g  =2"“*  column  of  A 


Table  4:  Determination  of  A  and  c 


Nov/,  the  unknown  velocities  can  be  calculated  as 


912 


To  get  the  position  corresponding  to  each  time  step,  Eq.  (90)  has  to  be  integrated 
numerically. 


6.3.3.  Comparison  of  Methods  Once  the  possibilities  of  solving  the  complex  kine¬ 
matics  of  the  roboTRAC  have  been  presented,  it  is  interesting  to  determine  the 
number  of  mathematical  operations  and  CPU-time  needed.  For  this  comparison,  a 
HP-Apollo  Workstation  Series  400  with  MC  68030  processor  has  been  used.  Table  5 
contains  the  number  of  mathematical  operations  as  well  as  the  CPU-time  needed 
for  calculating  the  right  hand  side  of  the  differential  equations.  The  optimizations 


VCM(O)  -  Optimized  variant  of  VCM 
CCM(O)  -  Optimized  variant  of  CCM 


Table  5:  Comparison  of  methods. 

involved  in  VCM(O)  and  CCM(O)  are  described  in  Vogel  1991.  Finally,  it  has  to 
be  emphasized  that  the  formulation  and  implementation  of  the  combined  constraint 
method  (CCM)  is  more  complicated  and  time  consuming. 

6.4.  Kinematical  Control  of  an  Experimental  SEtd'P 

Up  to  now,  simulation  results  are  demonstrated  by  means  of  diagrams  or  computer 
animation  (Fig.  20).  Another  possibility  is  the  development  of  a  controller  trans¬ 
forming  the  simulation  results  into  the  motion  of  a  scaled  model  of  the  mechanical 
system.  The  controller  is  based  on  the  /i-processor  INTEL  8039.  It  is  fed  from  a 
digital  computer  by  the  parallel  interface.  The  output  of  the  controller  is  connected 
to  a  multiplexer  distributing  the  signals  to  eight  servos,  which  represent  the  actuators 
of  the  mechanical  model  of  the  roboTRAC  (Fig.  21). 

7.  Implementation  specific  issues 

The  concepts  described  in  the  previous  sections  offer  a  high  potential  for  program 
optimization  and  modularity.  However,  they  are  difficult  to  realize,  because  (a)  their 
efficiency  depends  to  a  large  extent  on  a  thorough  modelling  of  the  sub-components, 
(b)  the  components  contain  a  great  deal  of  data  and  sub-functions  which  must  be 
administered  within  the  running  program,  and  (c)  the  solution  techniques  must  be 
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Figure  20:  Usual  visualization  methods. 

carefully  adapted  to  the  structure  of  the  equations.  To  cope  with  these  problems, 
a  series  of  techniques  have  been  developed,  which  shall  be  briefly  described  in  the 
following. 

7.1.  Symbolic  formula  manipulation 

The  resolution  schemes  described  in  Section  4.4.  and  Section  5.  lend  themselves  for 
symbolical  formula  manipulation.  Speciflcaliy,  an  implementation  of  the  methods  of 
Section  4.4.  has  already  been  carried  out  upon  the  symbolic  programming  language 
Mathtmatica.  Such  an  implementation  can  be  used,  on  the  one  band,  for  obtaining 
symbolical  expressions  of  the  resulting  scalar  equations.  For  example,  the  session  for 
the  inverse  kinematics  of  a  planar  four-bar  mechanism  looks  like  this: 

In  [2] :>  PlansFourBarNachanism 

0ut[2]«  {DHTraasloraCbetal,  0,  0,  1]  .  DHTran8form[b*ta2,  0,  0,  r]  . 

>  DHTransfom [betas,  0,  0,  d]  .  DHTransform[b«ta4,  0,  0,  s]  , 

>  -(b«ta2,  betas,  bata4}} 
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parallel  interface 


Figure  21:  Connection  between  computer  and  model. 


In [3] :>  GenerateConstraintsCPlaneFourBarMechanisa] 

0utC3]*  {ESFCl,  Null,  0,  0,  0], 

>  ESFCl,  Null,  0,  0,  0], 

>  ESFCl,  -Null,  0,  0,  0], 

>  ESFCO,  -b*ta2,  -2  r  ADHlCl,  4],  2  r  s, 

2  2  2  2 

>  -d  +  r  ♦  8  ♦  ADHlCl,  4]  ], 

>  ESFCO,  b«ta3,  d,  0,  -ADHSCl,  4],  -ADH3C2,  4]], 

>  ESFCO,  b*ta4,  SinCb«ta3],  Co8Cb«tt3],  -ADH3C2,  1],  -ADH3C1,  1]]} 

InC4];>>  GatSubstitutionsCX] 

OutC4]»  -CADHlCl,  4]  ->  -1  t-  8, 

>  A0H3C1,  1]  ->  CosCbatal]  Co8Cb8ta2]  -  SinCbatal]  SinCb«ta2]  , 

>  ADHSCl,  4]  ->  -r  ♦  ADHlCl,  4]  Co8Cb*tt2]  ♦  s  SinCb*ta2]  , 

>  ADH3C2,  I]  ->  -(CosCb«ta2]  SinCbatal])  -  CoaCbata)]  SinCbata2] , 

>  ADH3C2,  4]  ->  8  Co8Cbata2]  -  ADHlCl,  4]  SinCbata2]> 


Here,  the  notation  DHTransforaCbetal,  0,  0,  1]  is  a  short-cut  for  specify¬ 
ing  the  four  DENAVlT-HARTENBERG-parameters  of  a  general  transformation,  and 
ESF [sigma,  beta.  A,  B,  C]  is  a  shortcut  for  specifying  a  scalar  equations  of  order 
2  for  the  unknown  variable  beta,  which  is  either  rotational  (sigma  =  0)  or  transla¬ 
tional  (sigma  =  1).  The  lines  ESF[1,  Null,  0,  0,  0]  denote  identically  fulfilled 
constraint  equations,  which  are  typical  for  special  cases  of  over-constrained,  but  mov¬ 
able  mechanisms. 
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7.2.  0bJECT-OR!E.NTED  programming 

The  problem  of  integrating  the  concepts  in  a  running  program  can  be  effectively  tack¬ 
led  by  resorting  to  the  paradigm  of  object-oriented  programming.  Several  approaches 
have  emerged  in  the  last  years  for  can7/ing  out  such  a  modelling,  three  of  which  are 
of  particular  interest: 

•  Using  object-oriented  programming  for  program  structurization.  Excellent  ex¬ 
perience  where  made  endowing  traditional  FORTRAN-programs  with  an  object- 
oriented  shell.  By  this,  the  wretched  problems  of  variable  passing  in  huge  pro¬ 
grams  could  be  avoided,  and  the  efficient  implementations  already  performed 
earlier  could  be  integrated  into  large  programs  as  modules  with  literally  no 
side-effects  (see  e.g.  Hiller  and  Pichler  1993). 

•  Using  object-oriented  programming  for  algebraic  manipulations.  At  this  level, 
the  most  frequent  operations  involving  scalars,  vectors,  and  matrices,  are  im¬ 
plemented  at  an  abstract  level,  supplying  the  user  with  simple  interfaces  for  the 
definition  and  evaluation  of  composite  functions  and  their  derivatives  (Anan- 
tharaman  1993). 

•  Using  object-orieuted  programming  for  mechanical  modelling.  This  type  of  mod 
elling  aims  at  describing  the  physical  interrelationships  within  the  mechanical 
system  at  such  an  abstract  level,  that  generic  objects  can  be  identified  whose 
actions  can  be  described  without  resorting  to  any  particular  representations.  A 
particular  modeling  in  this  direction  is  the  treatment  of  mechanical  components 
as  “kinetostatical  transmission  elements”,  which  transmit  motion,  forces  and 
inertia  properties  along  the  multibody  system  (Kecskemethy  1993b). 

7.3.  Special  solution  techniques 

The  method  described  in  Section  3  for  formulating  the  equations  of  motion  of  multi- 
body  systems  in  minimal  coordinates  is  particularly  efficient  for  systems  with  com¬ 
plex  topology  including  multiple  kinematical  loops,  but  other  solution  techniques, 
which  are  often  based  on  other  types  of  coordinates  and  different  mechanical  prin¬ 
ciples,  may  be  more  suitable  for  particular  system  topologies.  Taking  advantage  of 
object-oriented  programming  methods,  it  is  quite  realistic  to  apply  alternate  solution 
techniques  within  the  same  program  environment.  Several  such  specialized  solution 
techniques  have  indeed  been  implemented  and  will  be  briefly  described  in  the  follow¬ 
ing: 

Recursive  methods  such  as  those  of  Featherstone  l983,  Brandi  et  al.  1986  were  for¬ 
mulated  for  the  forward-dynamics  problem  and  are  particularly  efficient  for  tree- 
structured  systems,  achieving  an  0{N)  operation  count,  where  A'  is  the  number 
of  bodies.  By  a  reinterpretation  in  the  context  of  a  differential-geometric  ap¬ 
proach  it  was  possible  to  implement  a  variant  of  this  method  as  an  option  in 
the  group’s  software  package  (see  Kecskemethy  1993a). 
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Hybrid  methods  which  combine  features  of  the  minimal-coordinate  method,  recur¬ 
sive  methods  and  absolute-coordinate  methods  can  be  applied  due  to  the  open 
and  modular  nature  of  the  object-oriented  programmign  environment.  Such 
methods  permit  formulations  tailored  to  a  particular  mechanical  system  (see 
Kecskemethy  1993a.  Anantharaman  1993). 

Direct  methods  for  dilTerential-aigebraic  equations  are  a  prerequisite  for  the 
use  of  absolute-coordinate  methods  or  the  hybrid  methods  mentioned  above  and 
permit  numerical  integration  of  the  equations  of  motion  without  resorting  to 
such  devices  as  coordinate-partitioning  or  constraint  stabilization.  In  the  form 
given  in  Anantharaman  and  Hiller  1991,  such  methods  are  easily  integrated  into 
existing  multibody  codes. 

8.  Conclusions 

The  approach  discussed  in  this  paper  shows  that  it  is  pos.  to  design  specialized  methods 
for  the  formulation  of  the  equations  of  motion  of  minimal  order  for  general  multibody 
systems  by  solving  the  kinematics  efficiently.  This  is  achieved  by  regarding  the  intuvidual 
kinematical  loop  as  the  main  building  brick  of  the  modelling,  and  developing  appropriate 
solution  schemes  for  the  solutions  of  its  local  kinematics.  Subsequently,  the  kinematics 
'■  '  can  be  incorporated  in  the  general  dynamics  procedure,  supplying  the  algorithm  with  the 

necessitated  terms.  The  advantages  of  the  approach  lie  in  its  possibility  of  yielding  compact, 
efficient  code  for  systems  of  virtually  any  complexity.  This  is  demonstrated  by  examples 
ranging  from  combined  wheeled  and  legged  vehicles  to  complete  passenger  cars.  Also, 
its  implementation  gets  increasingly  simpler  by  using  modern  programming  techniques, 
f  as  object-oriented  programming  and  symbolical  formula  manipulation.  These  features, 

!  together  with  new  possibilities  arising  with  the  advent  of  faster  hardware,  make  it  feasible  to 

use  the  approach  e.g.  for  incorporating  complex  models  of  mechanical  systems  in  hardWwce- 
^  in-the-loop  applications. 
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ABSTRACT.  This  paper  studies  second  order  accurate  methods  lo  numerically  time-integrate 
the  equations  of  motion  for  flexible  mechanism  dynamics.  The  aspects  of  stability,  accuracy, 
conditioning  of  equations  and  time  step  control  are  discussed  for  the  implicit  scheme  of  Hilber. 
Hughes  and  Taylor  'HHT) 


1.  Introduction 


i' 

! 


The  equations  of  motion  for  a  constrained  mechanical  system  present  the  form  of  a  mi.xed  set 
of  second  order  differential  and  algebraic  equations  called  a  system  of  differential/algebraic 
equations  (D.\E  system).  This  kind  of  systems  present  particular  characteristics  which 
difficult  their  numerical  treatment  and  difference  them  from  systems  of  ordinary  differential 
equations  (ODE). 

Probably  one  of  the  first  approaches  researchers  have  followed  to  solve  a  DAE  system 
IS  to  transform  it  to  a  system  of  second  order  ordinary  differential  equations  (ODE),  i.e. 
by  differentiation  of  constraints  or  by  using  a  penalty  formulation,  .\ctuallv.  one  popular 
technique  in  mechanisms  analysis  consists  into  differentiating  constraints  and  introducing  a 
stabilization  term  [l).  Then,  the  constraints  are  not  satisfied  e.xactly  but  oscillate  with  given  ‘ 

stabilization  period  and  damping  constants  about  the  exact  verification  point,  tending  to 
it  in  the  long-time.  The  inconveniences  of  this  approach  are  that  the  solution  depends  on 
some  rather  arbitrary  constants  to  be  selected  by  the  user,  and  that  the  constraints  are  not  : 

verified  e.xactly. 

Gear.  Petzold  et  al  [2-6]  developed  a  numerical  theory  of  D.4.E  systems.  They  showed  '  • 

under  which  conditions  the  use  of  integrators  developed  for  treating  ordinary  differential  ,  * 

equations  may  lead  to  acceptable  solutions  when  applied  to  differential/algebraic  systems.  |  ■ 

They  advocated  the  use  of  techniques  based  on  backward  differentiation  formulas  to  solve  • 

D,A.E  systems,  leading  to  schemes  which  preserve  sparseness  and  are  easy  to  implement.  |  \ 

Constrained  dynamics  equations  can  be  seen  as  formed  by  two  coupled  subsystems:  the  |  ; 

first  one  describes  the  structural  part,  while  the  second  subsystem  describes  the  constraints 
acting  on  the  structure.  Thus,  numerical  algorithms  for  integrating  these  systems  should 
be  able  to  cope  both  with  the  structural  part  and  with  the  constraints.  In  this  sense,  it 
seemed  natural  to  us  to  look  for  an  algorithm  within  the  vast  series  of  methods  proposed  to 
solve  structural  dynamics  ODE's  for  o\er  30  years  now  (see  [']  for  a  review  on  the  subject), 
and  introduce  eventually  to  it  the  necessary  modifications. 
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structural  dvnamics  equatioits  are  a  ^et  of  second  order  differentiai  equations  \uth  the 
-.lecuiiarity  o!  bein';  "stiff",  i.e.  the  system  eisenfrequencies  are  distributea  over  a  broad 
freauencv  ranse.  Stiffness  is  produced  either  b>  the  physical  properties  of  the  svstem 
or  bv  the  numerical  technique  followed  to  do  the  spatial  discretization.  For  tins  reason, 
structural  dynamics  analysts  seek  algorithms  which  benefit  from  unconditional  stability 
properties,  winch  imply  that  the  algorithm  is  stable  regardless  the  relation  between  time 
'teo  value  and  frequency  of  the  oscillator.  One-step  methods  are  preferred  to  muitistep  ones, 
since  they  are  self-starting.  The  cost  of  evaluating  functions  can  be  very  important;  thus, 
methods  with  a  single  function  evaluation  per  time  step  are  also  preferred.  Fully  backward 
difference  formulas  may  introduce  an  e.xcess  of  artificial  damping  in  the  interesting  part  of 
the  response,  and  tend  to  vield  better  results  in  first  order  than  in  second  order  problems. 

Many  well-known  algorithms  of  numerical  analysis  are  not  used  in  structural  dynamics 
because  they  do  not  possess  one  or  the  other  of  these  properties  (i.e.  Runge-Kutta.  Adams. 
Gear. ...).  The  most  popular  family  of  algorithms  for  the  solution  of  problems  in  structural 
dynaimcs  is  probably  the  Newmark's  one  [8).  which  is  based  on  the  interpolation  formulas: 

h’ 

9nTl  =  ?n  hqn  -r  —  {(1-23)?A  +  239n+l] 

?n-H  =  9n  +  h[(l-‘!)qn  +  7?n+l) 

where  J.*/  are  the  parameters  that  control  the  behavior  of  the  method.  Second  order 
accuracy  and  unconditional  stability,  without  energy  dissipation  in  the  whole  frequency- 
range.  is  reached  by  the  trapezoidal  rule  (J  =  0.25.7  =  0.5).  For  any  other  couple  of 
parameter  values,  the  algorithm  accuracy  falls  to  only  first  order. 

The  Newmark  family  has  served  as  the  basis  for  the  development  of  many  other  algo¬ 
rithms.  Researchers  have  tried  to  incorporate  properties  that  amehorate  the  performance 
of  the  algorithm.  For  instance,  unconditional  stability  is  not  maintained  for  all  nonlinear 
problems  e.xisting  evidences  of  trouble  with  softening  materials.  One  way  to  circumvent 
tills  inconvenience  is  by  introducing  some  numerical  dissipation  at  high  frequencies  in  the 
algorithm,  matching  in  some  sense  the  real  behavior  of  materials  and  structures  [9-12].  .An¬ 
other  recent  proposal  to  warrant  stability  in  the  nonlinear  regime  are  the  so  called  •■energy- 
conserving"  algorithms  (13-14). 

However,  there  exists  wide  concern  in  structural  dynamics  that  algorithms  of  integration 
should  provide  at  least  a  small  amount  of  dissipation  at  high  frequencies.  X  number  of 
modifications  of  the  classical  Newraark  time  integrator  have  been  proposed,  introducing 
hi2h  frequency  dissipation  while  retaining  second  order  accuracy.  Within  these  methods  we 
can  mention  the  o-method  of  Hilber  [9-10].  the  ag-method  of  Bossak  [11]  and  the  method 
by  Hoff  and  Pahl  [12).  This  aspect  has  been  found  of  upmost  importance  when  solving 
differential  algebraic  systems  [15-17).  The  trapezoidal  rule  presents  a  weak  instability  which 
is  e.xcited  for  all  values  of  the  time  step  when  applied  to  D.AE’s  (the  scheme  becomes 
unconditionally  unstable  i)  and  numerical  dissipation  reestablishes  stability  to  the  scheme. 
It  should  be  noted  that  this  observation  coincides  in  some  sense  with  that  of  Geai  and 
Petzoid.  since  backward  difference  formulas  completely  filter-out  the  high  frequencies. 

In  this  paper,  we  discuss  different  aspects  of  the  implementation  of  second  order  accurate 
algorithms  for  the  integration  of  the  equation  of  motion  in  constrained  dynamics  systems. 
We  analyze  first  the  system  equations  and  determine  a  set  of  equivalent  characteristic 
equations.  These  equations  serve  to  analyze  stability  and  accuracy.  The  application 
of  the  implicit  algorithm  of  Hilber.  Hughes  and  Taylor  ( HHT)  to  the  solution  of  constrained 
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liMiainics  svitems  is  ^tudle^i  ana  tiie  aspects  of  srab!iit\.  conditioning  oi  ecmations  and 
precMon  are  anaivzed  with  detail. 


2.  Constrained  Dynamics  Systems 


2  1  DERI\ ATIO-X  OF  THE  EQU.-^TIO.VS  OF  MOTION 


The  seneral  form  of  the  dynamic  equilibrium  equations  for  constrained  dtnamic  s\ stems  is 
tlie  lollowinsi;  n  equations  governing  the  d'naraic  behavior  of  the  system,  suppiemented  bv 
m  constraint  equations  introduced  using  the  Lagrange  multipliers  technique. 


Mq  -  -  G(q.q.f)  =  0 

^(q.t)  =  0 


with  M  the  structural  mass  matrix.  G  the  nonlinear  forces  vector  embodving  both  internal 
and  external  forces.  $  the  nonlinear  holonomic  constraints  vector  and  B  =  -  the  matrix 
of  constraint  gradients  (in  a  more  general  framework,  we  could  have  also  included  non 
nolonomic  constraints).  This  is  a  semuexpliat  system  of  second  order  differential-algebraic 
equations,  in  the  terminology  usually  employed  in  numerical  analysis. 

Our  mam  objective  in  vvhat  foUows  is  to  stress  on  the  specific  difficulties  encountered  in 
the  time  integration  of  second  order  D.A.E  systems  characteristic  of  constrained  dynamics 
systems.  First,  we  will  assess  linear  stability  and  convergence  by  analyzing  the  behavior  of 
the  integrator  for  the  linearized  homogeneous  system  of  equations: 


M 

0 


(2) 


■*0 

with  S  =  the  tangent  stiffness  matrix. 

U'e  will  assume  that  results  obtained  from  the  linearized  analysis  can  be  extended  to  the 
nonlinear  case  without  any  further  proof.  Interested  readers  are  referred  to  jbj  for  a  more 
rigorous  analysis.  Some  practical  aspects  of  equations  conditioning  and  error  estimation 
for  the  full  nonlinear  case  are  discussed  in  sections  3.3  and  3.4. 

We  shall  assume  that  the  linearized  system  (2)  is  solvable.  Solvability  for  a  hnear  system 
like  this  vvill  be  characterized  by  the  requirement  that  the  matrix  pencil 


/(A)  =  A 


M  O' 
0  0 


(3) 


be  regular,  that  is  that  the  determinant  of  the  matrix  function  /(A)  is  not  identically  zero. 

We  will  also  assume  that  the  mass  matrix  M  is  positive  definite,  which  is  a  reasonable 
assumption  in  structural  dynamics  problems.  However,  note  that  if  this  assumption  is  not 
verified,  we  may  consider  instead  the  following  modified  problem 


M’ 

0 


where  M'  =  +  is  positively  definite  for  Solvable  systems.  It  is  easy  to  verify  that  the 

solutions  to  both  D.AE  systems  (2)  and  (4)  are  strictly  equivalent,  since  bv  differentiation 


of  fORstrainis  v.e  are  able  lo  veiifv  that  the  computed  accelerations  should  lie  m  tue  kernel 
of  B'  B.  h  IS  aiso  immeaiateh  verified  that  the  correspondine  matrix  pencils  aie  strictlv 
equivalent. 

■-'.2  EIGENV.\H.  E  PROBLE.M  FOR  CO.\'STR.\INED  SYSTEM 

The  homogeneous  linear  dynamics  system  leads  to  the  following  associated  eigenvalue  prob- 


The  first  (n  -  m'  solutions  of  (5)  is  a  set  of  finite  frequencies  with  eigenvectors 

T  T  T 

4>{):  such  that  ,  verifies  the  equations  of  constraint  and  <f>^ ,  gives  the  corre¬ 
sponding  force  of  constraint.  N'e.xt  we  show  that  the  rest  of  the  spectrum  is  composed  by 
m  couples  of  frequencies  -  x  and  -x  associated  to  a  unique  eigenvector  ( 0^  ef  with 
e,  being  the  unitary  vector  with  a  1  at  the  i-th  row.  Therefore,  the  eigensystem  1 5)  admits 
the  following  n  —  m  solutions: 


Proof: 

We  introduce  a  small  parameter  i  into  the  eigensystem  in  order  to  eliminate  the  singularity  : 


ofM  \  S 

'  [O  -  .-B 


(7) 


B\  making  the  transformations 


and  by  considering  that  s  <  1  the  eigenproblem  (7)  is  transformed  into  the  eigensystem 


Solvability  of  the  D.\E  system  assures  that  the  matrix  of  constraint  gradients  B  is  well 
determined  (its  rows  are  hnearly  independent):  then,  the  rank  of  B  is  ni  and  there  e.xist 
{n  -  m)  linearly  independent  eigenvectors  with  frequency  .j!’  =  0  (which  correspond  to 
the  already  mentioned  (n  -  m)  finite  frequencies  of  (5)  ). 

We  will  now  compute  the  eigenvectors  of  r.on-zero  frequencies.  Since  the  mass  M 
(or  the  modified  mass  M")  is  positive  definite,  we  can  express,  from  i9-ai.  that 


(10) 
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After  repiadng  the  latter  eanatiou  into  (9-bi.  we  get  the  m-dimensiouai  fourth  order 


auxiiiarv  eigensv^item:- 


I--:-*!  -  =  0  (111 

The  solution  of  { 11)  is  given  by  the  following  '2m  eigenpairs  ; 

{(ili'.vi)  .  (-»){. V, I  .  (»/:’. v:j  .  ...  (-i/i.-Vnl)  (li) 

with  V,  normalized  to  give: 

vfBM"'B^v^  = 

By  now  using  equation  (10).  we  obtain  the  2m  solutions  with  non-zero  frequency  of  the 
eigensystem  (9); 


■(-«■{:;}) -(’M 


-'M:: 


w,-  =  -M~‘B^v,/ry* 

Using  (8)  we  see  that  the  full  eigenspectrum  of  (7)  is  given  by  the  set 


(4-{t:})-(4{X' 


Finally,  by  making  s  —  0.  we  see  that  the  eigenspectrum  of  (o)  is  composed  by  (n  -  m) 
finite  eigenfrequencies  plus  2m  eigenvalues  that  tend  towards  plus  and  minus  infinity. 
The  latter  values  have  associated  only  m  linearly  independent  eigenvectors  spanning  the 
subspace  W”  of  Lagrange  multipliers:  then,  by  linear  combinations  between  them  we  obtain 
the  full  set  of  solutions  (6). 

Remark: 

•  Infinite  elementary  divisors  of  the  matrix  pencil  f{X).  The  "infinite  frequencies"  we 
have  found  for  the  constrmned  dynamic  problem  (-5)  are  in  fact  infinite  elementary 
divisors  of  the  regular  matrix  pencil  /(A)  [18]. 

2.3  CHARACTERISTIC  EQUATIO.NS  FOR  CONSTR.AINED  DYNAMICS  SYSTEMS 

Usuall.v.  the  analysis  of  any  integration  method  is  made  by  following  a  two  steps  procedure: 
\i)  reduction  to  a  SDOF  model  problem;  (ii)  analysis  of  the  equivalent  SDOF  equation. 
However,  since  the  corresponding  undamped  eigensystem  does  not  have  {n  4-  m)  linearly 
independent  eigenvectors,  we  cannot  transform  as  usual  the  equations  of  motion  into  (n-l-m ) 
independent  equations.  \Ve  demonstrate  ne.Kt  that  the  linear  D.AE  system  (2)  can  be  made 
equivalent  to  (n  -m)  single  DOF  equations  plus  m  systems  of  2  equations  with  2  unknowns 
of  the  form  : 


Hi  +  -7  Pi  =  0 


1  =  1 _ n  -'m 


i  =  l....m 


Tlien.  the  behavior  of  the  time  integrators  when  dealing  with  constrained  dynamic  systems 
is  characterized  by  their  ability  to  treat  a  system  of  the  form  1 171. 

Remarks: 

•  A  matri.K  N  is  said  to  have  nilpotency  inde-v  i'  if  X*"  =  0  and  X‘'"‘  =  0.  The 
preceding  section  has  shown  that  the  linear  D.A.E  sy.stem  ('2)  is  equivalent,  through 
appropriate  transformation  matrices  and  'I'Jj  to  the  quasi-diagonaJ  svstem  of 
differential  equations 


where  N  =  DiagfNj.N: _ )  is  an  index-2  nilpotent  matrix  and  N:  is  the  index  2 

canonic  nilpotent  matrix  ^  ^  .  Usually,  the  degree  of  nilpotency  of  N  is  called  the 

index  of  the  (second  order)  DAE  system.  The  system  written  in  this  form  is  called 
canonical  quasi-diagonal  (Kronecker)  form  (18). 

.An  alternative  (and  easier)  way  to  compute  the  index  of  a  D.AE  system  is  by  successive 
differentiation  of  parts  of  the  system  (e.g.  the  constraints)  up  to  transforming  it  into 
a  system  of  ordinary  differential  equations.  The  minimal  number  of  differentiations 
needed  to  get  an  ODE  system  is  the  index  of  the  D.AE  (6). 

If  the  system  equations  describe  also  some  other  phenomena,  like  for  instance  system 
control  laws,  the  nilpotency  index  can  be  higher.  Thus,  in  a  general  case  we  can  be 
faced  to  systems  with  index  higher  than  two. 


3.  Implicit  Time  Integration  of  Constrained  Dynamic  Systems:  the 
Hilber-Hughes-Taylor  .Algorithm 

The  integrator  to  be  selected  should  be  able  to  correctly  integrate  both  the  "structural” 
and  "constraints”  parts  of  the  D.AE  system  (1). 

Several  integration  methods  e.xist  which  have  proven  to  give  correct  answers  when  deal¬ 
ing  with  structural  dynamics  equations,  that  is  which  solve  accurately  stiff  second  order 
ODE'S  systems.  Explicit  methods  are  recommended  when  high  frequencies  dominate  be¬ 
cause  relatively  short  time  steps  are  required.  For  the  low-frequency  response  of  multide¬ 
gree  of  freedom  systems,  implicit  methods  with  controlled  numerical  dissipation  offer  the 
advantage  of  suppressing  the  high-frequency  modes  of  the  numerical  model  which  do  not 
contribute  significantly  to  the  physical  behavior.  The  numerical  effort  can  thus  be  reduced 
without  loss  of  accuracy  by  using  large  time  steps. 

The  method  of  Hilber.  Hughes  and  Taylor  (HHT)  is  an  implicit  method  widely  used 
in  structural  dynamics.  It  consists  on  a  slight  modification  of  the  Newmark  algorithm, 
incorporating  algorithmic  dissipation  at  the  high  frequencies  and  retaining  second  order 
accuracv.  The  integration  formulas  can  be  summarized  as  follows,  in  the  homogeneous 


‘  -"I".- '  \ 


»■!« 


»a^«*»»vjr‘--ww 


jiuale  DOF  case: 

Fu)d  Sq  '-uch  that: 

h*  .. 

^fn-rl  —  H'r  ~  ^'/n  "*  ”7n  * 

'/n-I  =  9n  T  T  t24) 

9n+l  —  9n  T 

(jn-i-i  +  (1 -r-a-)'2^-9n+l  -  a2^w-^n  +  ( 1 -r  a )-'9n+l  “  a-’^i  =  0 

Parameters  q.  J.-  control  the  accuracy  and  numerical  damping  of  the  algorithm.  In  order 
to  get  second  order  accuracy,  the  following  relations  should  be  verified: 


J  =  ^(1-Q)'  -.  =  ^(l-2a)  (2.5)  ■  I 

leaving  only  one  parameter  free  which  takes  values  of  interest  in  the  range  -0..3  <  o  <  0.  t 

.Vumerical  dissipation  is  maximum  for  a  =  -0.3.  and  for  q  =  0  the  canonic  XewrcTark  5 

algorithm  without  dissipation  {3  =  i.*,  =  \)  is  recovered.  > 


3.1  ST.A.BILITV  A.V.\LYSIS 


The  Hiiber-Hughes-Taylor  algorithm  is  unconditionally  stable  with  second  order  ODE's. 
for  values  of  the  parameter  q  lying  in  the  range  [-0.3.0;  and  J.-/  computed  according  to 
equations  (25).  We  will  now  analyze  the  stability  of  this  algorithm  with  the  characteristic 
D.AE  system  (IT-b).  and  see  that  not  every  value  of  a  leads  to  stable  computations. 

We  first  regularize  the  system  by  introducing  a  small  parameter  s  that  eliminates  the 
singularity  of  the  "mass"  matri.x: 


We  make  afterwards  the  change  of  variables: 


y  = 


with 


Let  us  also  define  the  matrix 


(■26) 


(■2:) 


(•2S) 


(•29) 


such  that  the  following  properties  hold 


0 

1 


=  1 


1/s  0 

0  -1/-, 


' ' .  i  ^  ■-'■  %■  V  ■  V''  ■  -■' 


-1^ 

■“I 


-1 


CiWA-ssrMss^V’i*' 


Usii^ 


Tiieii.  bv  ore  and  post  muitipiyins  the  originai  equations  by  they  are  transformed 

to  the  uncoupled  system  of  differential  equations 


jti  -  -f  1/1=0 

1/:  -  -i  1/.'  =  0 


i:U) 


where  _■{  =  l/r.-t  =  -I/;. 

The  discrete  solution  of  (31)  is  given  through  the  amplification  matrix  of  the  integrator, 
in  the  form: 

{  Dl  n+l 


Y„+i  =  I 


hyi  n+l 
h-  'yi  n-nl 
l/I  n+l 

hh  n+l 

f)'h  n+l  j 


>  = 


A(fl,)  0 
0  A(fi;) 


(32) 


where  H,  equals  the  product  of  the  fr'quency  of  the  oscillator  i  by  the  time  step  h  =  tn-^i -U 
and  where  the  amplification  matrix  A(n,)  is  a  particular  function  of  the  numerical  time 
integrator.  _ 

Projecting  back  to  the  original  variables,  we  get  the  amplification  matrix  A,  of  the 
regularized  system: 


Zn+l  =  ^fiY„+i  = 


■A(n,)  0 

•  0  A(fl2) 


0  r 
1  0 


Zn  =  A,z„ 


(33) 


The  C  X  6  amplification  matrix  A  of  the  characteristic  D.A.E  system  is  obtained  by  taking 
the  limit  of  A,  when  s  —  0  : 


(34) 


ir  A(n,)-rA(n:)  (Aino-.^n^Dfl 

r-0  2  [(A(n,)- A(f22))/c  A(fl,)  +  A(n.)  j 

in  order  to  have  convergence,  the  matrix 

should  be  bounded:  this  implies  that  A.»  =  limn— w  A(fl)  =  limn _ »  A(fl).  Then,  the 

amplification  matrix  results 

[A^  0 

B  A-o 


A  = 


The  state  vector  at  time  is  obtained  by  successive  applications  of  the  amplification  matrix 
to  the  initial  state  vector  Zq  : 

7  -  /Z»"\  -  /  a;Z.o  \ 

”  ■  \Z2r.J  “  l(?(nA?^-‘B)Z,o  r  -‘V^Z.oj 

Then.  i:i  order  to  get  stability,  the  successive  powers  of  A>.  should  be  bounded. 
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Remarks; 

•  We  see  that  matrix  B  affects  the  computation  of  values  Z;.  uiiich  correspond  to  the 
Lagrange  multipliers  amplitudes.  This  equation  seems  to  indicate  that  in  order  to  set 
stable  results,  powers  of  the  amplification  matrix  should  necessarily  go  to  zero  to 
balance  growing  of  the  factor  n  in  the  term  tu  .A.x~* 

•  .Vote  that  there  e.xists  a  clear  uncoupling  between  Lagrange  multipliers  and  principal 
variables,  reflected  by  the  particular  structure  of  the  amplification  matrix  A.  Previous 
computed  values  of  the  principal  variables  Zi  influence  the  value  assumed  by  the 
Lagrange  multipliers  Z;  at  the  current  step,  but  the  previous  values  of  Z>  do  not 
influence  the  present  value  of  Zj. 

In  the  particular  case  of  the  HHT  algorithm,  the  amplification  matrix  relating  the  state 
vectors  computed  by  the  algorithm  at  t„+i  and  t„  can  be  written  in  the  following  form; 


[  Qn  “I 

/>9n+l 

1  =  A  1 

hqn 

1  J 

[  h-qn  ) 

IrdToUn^ 

I  (1-J)  (39) 

-yQ-  (l-!-{.J--)(l+Q)n')  l-7  +  (J-i)(i  +  Q)p.2 
-n-  -(i  +  Q)n*  (i  +  a)(/-4)n’ 


and  uhej'.  Q 

llie  ampuficanon  matrix  at  infinity  is  directly  deduced  by  computation  in  the  limit  when 
Q  —  giving: 


1 

~  (l-o)^ 

0  O'iifl. 

O 

0 

Q-  +  2q  -  1 

0 

> 

Q- 

(40) 

•i 

< 

L  Ui-ft) 

-4 

Q-  -  2q  -  I 

where  we  have  replaced  the  optimal  values  of  parameters  J,y  in  terms  of  the  dissipation 
parameter  o. 

An  analysis  of  this  matrix  gives  the  three  eigenvalues: 


Ai  =  — —  A:.3  =  -- — -  (41) 

1  4-  Q  1  —  Q 

For  Q  =  0  we  get  the  algorithm  of  Newmark.  Since  in  this  case  we  have  two  eigenvalues 
of  modulus  equal  to  one  with  only  one  associated  eigenvector,  there  will  be  some  elements 
of  A"  that  grow  as  0(n)  when  n  —  oc  and  the  algorithm  will  diverge  (see  its  Jordan  form 
below).  For  the  other  values  of  interest  of  o.  for  which  the  algorithm  includes  dissipation 
at  P  —  oc.  stability  is  recovered  since  the  eigenvalues  A,.i  =  1.2.3  are  smaller  than  1  in 
mod"  (q<0). 


'  ’t-''  ■-  v.'j 
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?nd  the  scheme  is  shown  to  be  stable  for  arbitrary  index  t/  whenever  0*0. 
COWERGENCE  OF  THE  ALGORITHM 

The  Hilber-Hughes-Taylor  algorithm  is  globally  second  order  accurate  (locally  third  order 
accurate)  for  second  order  ODE's.  with  values  of  the  parameter  o  lying  in  the  range  [-0.3.0] 
and  J.'  computed  according  to  equations  (25).  We  will  now  analyze  the  convergence  of  the 
algorithm  for  the  characteristic  DAE  system  (17-b).  First  we  regard  the  local  truncation 
error  and  see  that  high  index  systems  could  be  evep,, locally  divergent.  However,  we  show 
afterwards  that  results  are  globally  second  order  accurate  (after  several  steps)  when  using 
constant  step  size  and  whenever  the  loads  verify  enough  regularity  assumptions. 

Remark; 

•  It  is  easy  to  verify  that  the  e.xact  solution  of  the  algebraic  subsystem  can  be  written 
in  the  form; 

v-t 

z(f)=  (50) 

1=0 

where  u  is  the  nilpotency  index  of  the  DAE  system.  Note  that  the  solution  depends 
only  on  the  current  value  of  the  loads  and  derivatives:  note  also  that  if  the  load  is 
differentiable,  but  not  continuously  differentiable,  z  con  be  discontinuous. 

S.2.1  Local  Error.  Let  us  now  compute  the  local  truncation  error  of  our  integration 
algorithm  when  applied  to  this  system,  i.e.  the  error  of  integration  supposing  that  we  start 
the  step  from  exact  values  at  time 

The  difference  formulas  of  the  HHT  algorithm  can  be  written: 

hr 

z,+i  =  z{fn)  +  +  yaiffn)  +  Az 

z„*i  =  z(f„)  -f  hz(tn)  +  -^Az  (51) 

z„+x  =  z(r„)  +  -j^Az 

where  z(t„).z(f„).z(t„)  are  the  e.xact  values  at  time  Exact  values  at  time  can  le 
computed  by  adding  error  terms: 


^(fn+t)  —  2n+l  *f"  n+l 
i(tn+l)  =  Zn+i  +  -jjljer  n+l  +  Ti 

^n+l  "h  ^ d"  Ts 


(52) 


Here,  e.-  n+i  is  the  local  truncation  error  (in  displacements  z)  at  fn+i.  while  r,-  and  T;  are 
the  discretization  errors  introduced  by  the  approximation  of  difference  formulas  to  compute 
velocities  and  acce'erations. 

The  algorithm  advances  one  step  by  solving  the  weighted  equilibrium  equation: 


N(z(f„*v)-'^e:  n+l-Tj)  -r  (ll-Q)(z(fn+l)  “  n+l)  “  Q  Z(fn )  “  ( l+« )  fri+l  t  O  =  0 

(53) 
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Bv  »akiua  iiuo  account  that  the  ettuihbiium  equation  is  exactly  verified  bv  actual  \alues 
Z‘t. zif.  zitt  !•  i.e.  ; 

-  Zttn.l/  -  fn*l  ■-  0  1)4) 

ue  set  the  following  equation  for  the  local  truncation  error  at  tn^i: 

-irN  -  (l-*-a)l]e..„+i  =  -  z((„))  -  Nr;  cj5) 

j/i-  j 


Next,  we  eliminate  Az  between  equations  (.51-a)  and  (51-c).  and  between 
b)  and  {51-ci  to  get: 


equations  (51- 


z(t„*i)  =  z(f 


(h^  \ 

z(t„  +  i)  -  Z(f„)  -  /iZ(J„)  -  YZ((.,)j  -  T: 

'n)  -i-  ■^{z{tn+i)-Z(tn)-hi(tn)-Y^itn)j  +  T; 


1  /  h’  \  ^ 

z(t„+l)  =  Z(f„)  -i-  -jp  fz(t„+i)-z(t„)-/iz(t„)-  yzifnlj  T; 

and  using  a  Taylor  e.xpansion  of  the  displacements  z{fn+i)>  velocities  zdn-i  )  and  acceler¬ 
ations  z(fn*i)  around  t„.  we  get  the  expression  of  the  discretization  errors  r...r;  in  terms 
of  the  third  derivative  of  displacements  at  t„ 

/  1  \ 

Tj  =  +  O(h-) 

Therefore,  the  local  truncation  error  at  (n+j  is  given  by  the  expression: 

-b  (l-l-o)lje,„+i  =  -^l-i-Q-^^/tNzdn)  (5S) 

.\fter  solving  this  system,  we  get 


ern  +  t  =  -  (i-  6^(1  /'ll  +  N'z(f„) 


0 

h’i'l(tn) 


/  1  ^ 

”  V  ~  6J(1  -ha)/  ]  jaiiVc)  +  />- 2(fn) 


Thus,  we  see  that  the  local  truncation  error  for  the  i-th  component  of  z  for  an  index-t/  D.\E 
system  is  an  0(/i’"'')  (except  the  first  component  which  is  verified  e.xactly).  Note  that  for 
systems  of  index  higher  than  2.  computed  values  exhibit  a  divergent  behavior. 

3.i.2  Global  Error.  It  is  well  known  that  for’ordinary  differential  equations  the  order  of 
the  global  error  is  one  order  smaller  than  the  local  error.  For  instance,  the  local  error  of 
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tlie  HHT  aiaorit!\m  being  0{h^\.  then  this  algorithm  ts  globally  second  order  accurate  for 
ODE'S. 

■Although  the  local  error  estimates  show  a  divergent  behavior  for  algebraic  systems  with 
inde.x  equal  or  higher  than  when  applying  the  algorithm  with  constant  step  size  the 
alobal  error  reaches  second  order  accuracy  after  several  steps  (the  same  observation  holds 
for  other  integrators  used  for  D.A.E's.  like  BDF  I’Cj). 

We  analyze  ne.xt  the  global  error  of  the  Hilber-Hughes-Taylor  algorithm  for  an  inde.x-'2 
algebraic  system.  Let  us  define  the  vector  of  local  trincation  errors  e  which  consists  on  the 
displacements,  velocities  and  accelerations  errors: 

=  (C;!  fieri  fi’C:!  fif :  2  fi'S;  2  )  (60) 

The  vector  of  local  truncation  errors  e  verifies  the  equation 

Z«„4.i)  =  AZ(tn)-rLnr-e„  (61) 

where  Z(l)  =  (ii(f)  hz\(t)  h':i(t)  ;j(t)  fiij(t)  fi-Hoft) )  is  the  state  vector  of  exact 
values.  A  is  the  amplification  matrix  of  the  algorithm  (36)  and  Ln  is  a  vector  that  depends 
on  the  applied  loads  (/i(0  By  using  the  exact  solution  (50)  into  the  latter 

equation,  and  by  retaining  higher  order  terms  than  in  the  previous  subsection  we  can  show 


By  subtracting  from  (61)  the  integration  equation  in  terms  of  the  appro.ximate  values 
computed  by  the  algorithm,  we  get  the  expression  for  the  propagation  of  errors: 


En+l  =  AEji  -r  Cn  =  A  Eo  T  2^  A  ©n-fe 

<=0 


(64) 


\vithE  =  (£;i  /i£;  1  h-E:i  l>£:2  /i'£rQ )  il>e  global  errors  vector. 

If  we  assume  mild  enough  conditions  (i.e.  sinootliness  of  the  applied  forces  and  their 
derivatives),  and  since  A  —  0  for  n  —  x.  we  mav  write  that  for  /)  —  0 


E  —  ^a’^ICiVi  -i-  CSv;  -r  C3V3  -r  C^v^ 


(65) 


k=0 


The  amplification  matri.K  of  the  iiide.'c-2  algebraic  system  was  given  in  equation  (36). 
Note  that  for  tliis  matrix. 


;=o  '• 


y-x>  .k 
2^k-0 


uzrio '^«)B(i:r=oAt.)  Er=oA 

For  Q  <  0.  the  amplification  matrix  of  the  algorithm  verifies 


(66) 
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(67; 


(this  series  can  be  easily  evaluated  using  the  Jordan  form  and  projectors  Wi.  Wr  (42-43)). 
After  replacement  into  (66)  we  get 
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-1  4-0 

1  'i-t-eo 
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1  i-Q 
-1 
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0 

0 

0 

1 

-1 


0 
0 
0 
0 

-  o  J 


(68) 


Finally,  replacement  of  (68)  into  equation  (65)  yields  the  expression  of  the  global  error 
of  the  algorithm 

0  'I 


E  -  { 


Cjo'/i^ 

C3^ 

Cil±^h^ 

CsoV 


I  .-O  t.'t  I 

/  -r  V,  .V  I 


where  constants  C,  differ  from  those  in  equation  (65). 

Remarks; 

•  Similar  estimations  can  be  obteuned  numerically  for  higher  index  systems. 

•  The  global  error  estimates  are  correct  provided  the  time  step  is  kept  constant  and 
loads  and  derivatives  are  smooth  enough.  Changing  the  step  size,  or  introducing 
a  discontinuity  in  loads,  generates  a  perturbation  which  affects  the  computations 
for  some  steps.  .A.fter  a  while  this  perturbation  is  damped  out  and  the  results  gain 
accuracv. 
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3.3  CONDITIONING  OF  EQUATIONS 

The  system  equations  in  their  original  form  can  be  very  ill  conditioned,  thus  causing  diver¬ 
gence  of  the  Newton  iteration  due  to  error  cumulation.  We  analyze  ne.\t  the  D.AE  equations, 
by  regarding  again  the  full  system  representation,  and  look  for  a  way  to  improve  the  system 
condition. 

The  HHT  algorithm  can  be  written  in  the  form; 


Find  Aq  {•ucb  that: 

.  .  h-.. 

qn+i  =  qn  +  Hn  +  yqn  +  -^q 

qn+1  =  qn  +  />qn  +  ^^q  (70) 

qn+1  —  qn  "b  j^>  ■^q 

Mq„+1  T  (l  +  a)G(q„+i)  -  aG{q„)  -  (l  +  a)fn+i  =  0 


Equation  (70-d)  depends  nonlinearly  on  the  generalized  displacements  vector  q„+i.  Thus, 
a  system  of  nonlinear  algebraic  equations  has  to  be  solved  at  each  step  to  advance  compu-- 
rations.  This  system  of  equations  is  solved  iteratively  using  the  Newton- Raphson  method. 

.At  each  iteration  of  the  Newton  method,  a  system  of  linear  algebraic  equations  is  solved. 
Let  us  write  this  system  for  a  typical  iteration,  i.e.  when  going  from  iteration  k  to  iteration 
k  +  1: 


(_L 

M 

o' 

\3h^- 

0 

0 

+  (1  +  a) 


(71) 


where  ( ^  'S  the  residual  vector  at  iteration  k.  and  where  we  have  taken  into 

account  the  presence  of  holonomic  constraint  equations. 

The  inverse  of  the  coefficients  matrix  for  h  —  0  can  be  computed  in  the  form: 


fj- 

\dh- 

'M 

0 

o]  + 

+  a] 

K 

-B  0  ])  - 

^11 

lSa,  Saa, 

S,,  = 

3h- 

(m-'  - 

')  +  0{h*) 

S,x  = 

“[I 

^  M-' 

+  Q) 

-f  O(h') 

Sa,  = 

3<,A 

1 

+  a)'-^h^- 

Saa  = 

“(1 

(BM- 

'*B^)-^  -f  0(1) 

(72) 


(73) 


We  can  see  that  this  coefficients  matrix  is  very  ill-conditioned  due  to  the  presence  of 
constraints  (the  condition  number  is  an  0(m'//i^).  where  "m  is  the  mean  mass  of  the 
system).  If  we  try  to  solve  this  problem  without  scaling,  the  Newton  algorithm  will  not 
converge  since  round-off  errors  would  become  of  the  same  order  of  the  Newton  correction 
itself. 


A  better  coiiditionittg  of  the  coefficieius  matrix  can  be  reached  by  solving  the  syinmer-  I':  j 

ncally  scaled  problem:  "  \ 

:  ! 

< 

I  Mq  -  .  G(q.q./)  =  0  j 

[  /<ic#(q.O  =  0  I 

where  the  scaling  factor  fac  is  equal  to  Tri/h-.  In  this  way.  the  condition  of  the  coefficients  * 

matrix  becomes  independent  of  the  time  step  and  of  the  mean  value  of  mass.  The  new  ,  j 

svstem  of  equations  to  be  solved  writes:  | 


f-L 

\3h- 

M 

0 

o' 

0 

+  (1+0) 

■  K 
-B- 

-ri) 

j  \ 

IaA''-'**/  “  ' 

(7-5) 

B- 

A- 

m 

(76) 

The  drawback  of  this  technique  of  equations  balancing  is  that  the  scaling  factor  depends 
on  the  size  of  the  time  step,  posing  some  practical  inconveniences  from  the  point  of  view 
of  programming.  VVe  have  also  obtained  good  results  using  as  scale  factor  a  mean  value  of 
the  stiffness  of  the  system.  Nevertheless,  it  should  be  noted  that  in  very  severe  cases  for 
which  the  time  step  is  highly  reduced  the  algorithm  may  fail  and  the  user  has  to  restart 
computations  and  increase  this  scale  factor. 

Remark; 

•  ‘The  Newton  iteration  is  stopped  when  the  norm  of  residual  vector  becomes  smaller 
than  a  given  threshold.  The  stopping  criterion  is  based  on  comparing  the  residue  to 
characteristic  measures  offeree  fchar  Uor )  and  of  displacement  fesor  (for  tj^).  Note 
that  in  order  to  be  consistent,  the  threshold  value  for  the  constraints  equations  should 
also  be  affected  by  the  scaling  factor.  Thus,  the  convergence  criterion  mav  look  like: 


,  (MV, (MV  <  TO,-;, 

\jcnar/  \^char  /  \jchar/  V^char/ 


(") 


If  we  do  not  scale  the  constraints  threshold,  the  convergence  requirements  will  be  too 
stringent  and  the  method  would  fail  to  find  a  solution. 

;  4  CONVERGENCE  AN.VLYSIS  FOR  THE  FULL  SYSTEM 


.\n  estimate  of  the  local  truncation  error  of  the  algorithm  evaluated  for  the  full  system  will 
be  used  to  determine  the  new  time  step.  The  difference  formulas  of  the  HHT  algorithm 
are  as  indicated  in  the  preceding  section.  The  weighted  equilibrium  equation  is  solved 
iterativelv  in  the  nonlinear  case: 


M  fq(rn+l )  - 


+  (1  +  Q)G(q(tn+l )  -  Cn+l )  -  QG(q(<„)) 


-  (l-rQ)fn+l  +  ofn  =  »? 


(7S) 


f 

-.a. 

t  ■ 

g-  '--I 
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In  this  equation  »/  are  the  unbalanced  forces  reniaining  at  the  end  of  the  iterative  cycle 
used  to  solve  the  nonlinear  problem  (typically,  a  .Xewion  method  is  used).  The  nonlinear 
forces  vector  evaluated  at  (q(tn+i)  can  be  e.xpanded.  to  a  first  order,  as 


OG 


—  e„+i)  =  G(q(fn,  t  -  —— e„+i  +  0(e' 

c'q 


(79) 


.\fter  replacing  this  e.vpression  into  (7.?).  and  by  taking  into  account  that  the  equilibrium 
equation  is  e.xactly  verified  by  correct  values  q(t/.-).q((;:).q{(t-)-  i-e-  : 


Mq(tn+i)  +  G(q((„+i))  -  f„+i  =  0 


(80) 


and  by  replacing  the  e.xpression  of  the  discretization  error  Tj.  we  get  the  following  equation 
for  the  local  truncation  error  at  tn+i: 


1 


^n+l  =  -  I  1 


hMq(t„)  ~  tj 


(81) 


If  we  now  compute  e.xpiicitly  the  contribution  of  the  constraints,  we  get  the  following  svstem: 


[3h^ 


M  0 
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+  (1  +  Q) 


K  -f-B 
-fB  0 


){?>:::}  = 

_  I  +  -  I  *^2  I 


(82) 


.4.fter  computing  the  inverse  of  the  coefficients  matrix  (equation  (73)),  the  truncation  errors 
can  be  expressed  as  follows: 


n+l 


=  [l  -  M->B^(BM-*B^)-»B]|r'l  +  Q)d-i)fi’q(t„)  +  + 


_1_ 

l-fo' 


t'i 

+  -^M-^B^(BM-’b’')-’ 

V  /n  '' 


=  0(/i^)q((n)  +  0{h'lm)r}  +  0(h-/w)t1\ 


n+l 


+  7TT^(BM-'b^)-*:^»7;; 

{1  +  q)-o  nr 

=  C{h^)q(t„)  +  0{h-lm)ri^  +  0{h-/m}T}\ 

(83) 

The  previous  expressions  shows  that  the  truncation  error  depends  uniquely  on  the  deriva¬ 
tives  of  the  displacements  and  on  the  error  of  the  solution  of  the  nonlinear  problem  and  is 
independent  of  the  Lagrange  multipUers. 

If  we  now  consider  that  the  tolerance  for  the  constraints  residue  in  the  Newton  iteration 
is  scaled  by  {h-fni)  (equation  (77)).  we  get  the  following  estimations  for  the  norm  of  the 
truncation  error  in  terms  of  the  tolerance  for  the  out-of-equilibrium  forces  TOLtqV. 


I|e,n+ill  <  Q(/i^)irq„||  +  0(l)WrOI„, 
!!<t„+il!  <  G{/.3)i|qj|  o(i)f,^„roi,„ 


(84) 
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TJie  truncation  error  for  the  Lagrange  multipliers  is  obtained  bv  multiplying  (C'4-bi  by  the 
scale  factor  (7!i/h-)  : 

l|e.\n+li|  <  OfTii/l)  llq'nli  -r  Oinifh-)  (char  TOLf^i  f.?5) 

Thus,  we  see  that  the  equations  balancing  only  affects  the  Newton  iteration  and  does  not 
have  any  effect  on  the  accuracy  of  results. 

Remark: 

•  We  have  seen  that  the  accuracy  of  displacements  is  not  influenced  by  the  truncation 
error  of  the  Lagrange  multipliers  and  that  the  main  factor  that  could  deteriorate 
the  displacements  convergence  rate  is  a  loss  of  equilibrium  at  the  Newton  iteration. 
Indeed,  equation  (83)  points  out  the  relation  between  the  integration  error  and  the 
loss  of  equilibrium,  relation  which  we  will  take  into  account  to  establish  appropriate 
values  for  the  integration  error  and  for  the  equilibrium  tolerance. 

3.5  TIME  STEP  CONTROL 

The  task  of  fi.xing  the  time  step  size  at  each  instant  of  the  algorithm  by  the  user  could  be 
quite  difficult  in  many  situations,  noting  that  : 

-  If  the  selected  time  step  is  too  large,  the  error  in  the  computed  response  will  be  large, 
masking  important  aspects  of  the  response.  A.  large  time  step  would  also  increase 
the  degree  of  nonlinearity  of  the  algebraic  system,  with  a  consequent  increment  of 
the  number  of  iterations  per  time  step  or  even  giving  place  to  a  divergence  of  the 
Newton-Raphson  algorithm. 

-  If  the  selected  time  step  is  too  small,  the  cost  to  obtain  a  solution  would  be  increased 
with  a  waste  of  computer  resources,  even  to  the  point  of  becoming  practically  unac¬ 
ceptable  in  many  cases. 

Several  techniques  have  been  proposed  to  control  the  time  step  in  nonlinear  dynamics: 

-  from  a  comparison  of  results  between  algorithms  of  different  order  [19-21): 

-  in  terms  of  a  dominant  frequency  of  response  [22): 

.2  _  -^q^KAq 
■  AqJ-MAq 

-  after  a  measure  of  nonlinearitv  (current  stiffness  parameter,  number  of  iterations. . . . ) 
(23): 

-  using  the  local  truncation  error  (24-27). 

The  technique  we  follow  to  limit  the  time  step  is  based  on  controlling  an  estimate  of 
the  local  truncation  error  of  the  algorithm.  In  fact,  the  step  will  be  controlled  baised  on 
monitoring  the  norm  of  the  local  truncation  error  at  the  displacements  terms  only,  and  the 
error  in  the  Lagrange  multipliers  will  not  be  taken  into  account  since  their  appro.\imation 
order  is  worse  than  that  of  the  displacements. 

If  we  neglect  the  residue  of  the  Newton  iteration,  an  estimate  of  the  local  error  is  given 
by  approximating  the  third  derivative  of  displacements  as  the  difference  of  accelerations: 

e,„+,  =  [l  -  ((l-}-a)^-i)/.=Aq  (87) 

with  Aq  =  q„+i  -  q„.  This  approximation  will  be  valid  provided  the  tolerance  for  the 
out-of-balance  forces  is  small  enough. 


’•T 


183 


3.0.1  Analysts  of  the  Local  Error  Esthnatwn:  the  SDOF  Oscillator:  A  standard  practice 
for  estimating  a  time  step  in  structural  dynamics,  is  based  on  comparing  it  to  the  peiiod  of 
oscillation  of  the  structure.  Usually,  the  time  step  is  selected  so  that  one  period  is  integrated 
by  using  10  integration  steps.  In  this  section,  we  establish  a  comparison  with  this  criterion 
fo  determine  an  estimate  of  the  local  error  that  will  give  accurate  results. 

Let  us  consider  a  linear  SDOF  oscillator  submitted  to  an  initial  displacement  yo- 


it  +  y  =  0 

(SS) 

y(0)  =  yo  y(0)  =  0 
Clearly,  the  e.xact  solution  to  this  problem  is 

y{t)  =  yo  cosM)  (89) 

Let  us  suppose  we  are  at  time  t.  instant  for  which  we  know  the  e.xact  solution  y{t).  and 
that  we  integrate  one  step  the  dynamic  equations  using  HHT  with  a  time  increment  h.  The 
change  of  displacements,  velocities  and  accelerations  from  t  to  (f  +  h)  can  be  written  in  the 
form: 

f  Ay  ]  f  yo  cos(*'/)  ] 

{  /lAy  }  =  (A(n)-l)  {  -fiyosinlw-f)  }  (90) 

(,  h*  Ajf  J  (  -O-yo  cos(u)t)  j 

.Afier  replacing  the  e.xpression  of  the  amplification  matrix  A(fl)  into  equation  (90).  we  see 
that  the  local  error  measured  by  equation  (87)  results  : 

€  (l  +  a)f(l  +  a)5- ,  /I  A  ^ 

W - l  +  (5 - 

The  quotient  e/|yo|  can  be  seen  as  a  non  dimensional  error,  independent  of  the  oscilla¬ 
tor  excitat'on.  Xote  howe'er  that  this  measure  still  depends. on  time.  To  eliminate  this 
dependence,  we  define  the  expected  value  of  the  non  dimensional  local  error  S  in  the  form: 


E(e)  limr-^  I  (//  c-  dt)* 


Using  equation  (91).  we  can  see  that 


—  - ■= - -  — - -  Vi'Vi 

^/2  (l  +  ll  +  a);3n^) 

This  function  is  plotted  in  figure  1.  We  can  see  that  it  is  a  monotonically  increasing  function 
of  the  non  Jimeusional  frequency  D. 

Remark: 

•  We  can  appreciate  also  in  figure  1  the  non  dimensional  cut-off  frequency  fl/c.  It 
indicates  indirectly  the  maximum  value  of  the  time  step  h  to  integrate  accurately  the 
equations  of  motion  of  an  oscillator  of  frequency  w'.  It  is  usually  accepted  that  for  a 
non  dimensional  cut-off  frequency  fl/c  =  0.6  -v^ue  corresponding  to  a  time  step  equal 


Figure  1  •  Non  dimensional  error  function  5(0) 

to  one  tenth  of  the  oscillator  period-  the  algorithm  gives  enough  accurate  results  from 
an  engineering  point  of  view.  The  minimum  spectral  radius  at  this  frequency  equals 

P(0-6)la=-o.3  =  0-9981 

Let  us  define  the  constant  A'n  =  5(0k).  From  the  definition  of  0/;.  the  quotient 
S{Q)JKn  will  be  greater  than  or  equal  to  1  for  values  of  frequency  exceeding  Qk-  Therefore, 
if  we  accept  that  the  expected  and  actual  values  of  the  local  error  are  equal  (in  mean),  we 
can  write: 


[(ixa)j-l]  /,3 


lAj/l  « 


Efe) 


5(0) 

A’n 


>  1 
<  1 


if  0  >  Ok 
if  0  <  Ok 


A'n  il/ol  A'n  |j/ol 

Then,  by  integrating  the  differential  equation  (88)  with  a  time  step  that  verifies: 

[(l-foU-l)  h'- 


A’n  ivol 


lAy|  <  1 


(94) 


(9-5) 


the  time  step  will  be  adjusted,  in  mean,  to  verify  0  <  Ok-  In  other  words,  the  time  step  h 
will  take  values  for  which  the  algorithm  integrates  correctly  the  equations  of  motion  of  the 
oscillator. 

S.5.2  Analysis  of  the  Local  Error  Estimation:  the  MDOF  System:  Let  us  compute  the 
double  product  of  the  local  truncation  error  with  the  mass  matrix: 


(e[Me,) 


1/2 


(l  +  a);5-  i 


-  Aq^  |m  -  B^(BM"‘B^)-'b|  Aq) 


1/2 


(96) 


Since  the  second  term  on  the  right-hand-side  is  strictly  negative,  we  get  the  inequality: 


(e[Me,) 
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(l+a)i3-i 
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k-  (Aq^AGiner) 
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(97) 
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\vliere  4G,ntr  =  MAq.  Lei  us  now  define  a  relative  error  function  tret  m  the  form 


(rt! 


n,-)  < 


m) 


T  W ' 

where  the  reference  length  (  =  (qoMqo)  '  is  a  mass-norm  of  the  characteristic  displace¬ 
ments  qo- 

The  integration  time  step  will  be  selected  such  that  the  relative  error  is  smaller  than 
a  user-defined  tolerance  TOL,nt-  Thus,  the  relative  mass-norm  of  the  truncation  error  of 
displacements  will  be 

<  tOLm  (99) 

In  this  way.  the  time  step  will  be  adjusted  to  integrate  (in  mean)  using  iO  steps  per  period, 
for  a  single  DOF  system  if  the  tolerance  TOL,nt  is  fi.xed  equal  to  1.  In  a  .\IDOF  system, 
the  time  step  will  be  such  that  there  will  be  iO  steps  (in  mean)  per  dominant  period.  See 
the  remark  below  for  a  different  interpretation  of  this  criterion. 

The  tolerance  TOL,nt  is  independent  of  the  problem  under  analysis.  Computer  e.^peri- 
ments  have  shown  that  a  value  of  TOL,m  in  the  range  1  x  10"'  -lx  10“®  gives  correct  results 
for  the  engineer,  with  a  good  compromise  between  accuracy  and  economy  of  computation. 

Remarks; 

•  It  can  be  shown  that  if  the  lime  step  is  selected  such  that  the  relative  error  Crei  is  below 
a  given  toler^ce  TOL,nu  the  sum  of  amplitudes  of  modal  components  exceeding  the 
cut-off  frequency  Qk  will  be  bounded  by  TOLint : 


^ret  ^  'TOLint 


yo 


1/2 


<  TOL„ 


(100) 


Therefore.  TOLi„t  limits  indirectly  the  amount  of  energv’  dissipated  by  the  algorithm. 
The  estimations  above  will  be  valid  provided  the  error  coming  from  the  out-of¬ 
equilibrium  forces  is  small  enough.  The  following  relation  between  the  integration 
tolerance  and  the  equiF’  ium  tolerance  is  based  on  demanding  an  equilibrium  error 
one  order  of  magnitude  elow  the  error  of  integration; 


rOie,t  < 


TOLtntk'n 

10 


(101) 


•  The  analysis  has  been  made  considering  the  integration  of  linear  systems  with  an  al¬ 
most  constant  time  step  h.  The  developed  algorithms  can  be  e.xtended  to  the  nonlinear 
case  without  any  further  difficulty. 

3.5.S  Simtegy  for  Changing  the  Time  Step  ;  The  changing  step  strategy  should  be  such 
that  it  keeps  the  integration  step  constant  during  long  periods  to  avoid  a  deterioration 
of  performance  and  to  be  in  agreement  with  the  already  developed  theory  and  with  the 
stability  and  accuracy  criteria  of  the  HHT  integrator.  Therefore,  the  strategy  should  try 
to  keep  the  time  step  unchanged  unless  strictly  necessary. 
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By  aii2Llyzing  equation  (931.  we  can  estimate  the  effect  of  varying  the  time  step  on  the 
computed  relative  error.  By  computing  the  quotient  of  errors  for  two  different  time  steps 
III.  Ii-t.  we  can  note  that 


irdlhi)  "  Xhi) 


(102) 


The  integration  time  step  wiU  be  fixed  according  to  the  relation  between  the  relative  error 
and  the  user  fixed  tolerance.  We  follow  a  conservative  criterion,  similar  to  that  presented 
in  ref.i‘21)  :  at  any  time  instant  we  will  try  to  keep  the  relative  error  equal  to  half  the 
tolerance.  We  distinguish  between  four  cases  : 

i.  If  the  error  exceeds  the  tolerance,  the  computed  step  is  rejected  and  recomputed  using 
a  time  step  <‘qual  to  half  the  previous  time  increment. 

ii.  If  the  error  is  less  than  the  tolerance,  but  greater  than  half  its  vaiue.  we  accept  the 
computed  step  but  the  i>c.xt  time  step  rs  decreased  trying  to  make  the  relative  error 
equal  to  TOLf2.  using  equation  (102). 

iii.  Whenever  the  relative  error  lies  between  TOL/2  and  TOLflQ.  we  keep  unchanged  the 
time  step.  Tliis  criterion  is  based  on  considering  that  if  the  time  step  is  doubled,  the 
reiative  error  will  be  greater  than  half  the  tolerance. 

iv.  If  the  relative  error  is  less  than  rOi/16.  we  accept  the  step  and  double  che  time  step. 


4.  Examples 
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4.1  C.A.NO.MC  NILPOTENT  SYSTE.M 

This  first  e.xample  treats  the  canonic  nilpotent  system  of  index-3; 

N3Z-fZ  =  fl/) 


with  loads 


The  exact  solution  is 


z{i)  = 


(  exp(r) 
f=:  <  COS(5f) 
i  e.xp(3f) 


exp(f) 

co3(5/)  -  e.xD(f) 
exp(3/)  -1-  25  cos(5/)  -f  exp(f) 


Figures  2  and  3  show  the  computed  displacements  with  a  constant  time  step  h  =  0.01 
and  dissipation  parameter  a  =  -0.3.  compared  to  the  exact  solution.  We  note  that  cj 
and  Z2  are  in  close  agreement  to  the  exact  solution,  while  =3  exhibi's  a  perturbation  at  the 
initial  steps  which  is  damped  out  after  t  w  0.2. 

Figures  4  and  5  show  the  evolution  of  velocities.  Note  that  now.  I)o;i»  c>  and  i3  are 
perturbed  at  the  beriming  of  computations.  Note  also  that  the  amplitude  of  spurious 
oscillations  of  ;>  is  such  that  they  mask  the  response  at  the  subsequent  steps. 

Table  1  gives  the  global  error  at  time  t  =  3  for  different  values  ot  the  time  step.  We  can 
see  verify  tliat  the  error  for  the  first  compontnt  is  always  zero,  and  that  the  second  and 
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Figure  S  -  Displacements  Z3;  nilpotent  canonic  index  S  system 


tliird  components  converge  with  quadratic  rate.  However,  we  remark  that  the  quadratic 
rate  is  lost  for  the  third  component  for  steps  smt^er  than  h  =  O.Ol,  most  probably  due  to 
round-off  errors  cumulation. 

4.2  SIMPLE  PE.NDULUM 

Ih'thi’s  example  we  analyze  the  response  of  a  simple  rigid  pendulum.  The  system  has  unit 
length,  a  unit  mass  at  the  extreme  and  oscillates  freely  from  a  horizontal  initial  positjon  in 
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(l(xl)Ali.d(i2)Aii 


a  j  =  10  gravity  field.  The  system  of  equations  to  be  solved  follows: 

(  iji  -  29,  A  =  0 

<  9;  —  29>A  =  — 10 

I  . 

I  <!{  T  95  =  1 

The  system  was  solved  by  using  a  variable  step  size,  for  various  error  tolerances 
{TOL,„t  =  0.001.0.01.0.1. 1).  Table  2  shows  the  mean  time  step  used  in  the  different  cases, 
together  with  the  effectively  computed  mean  integration  error.  We  see  that  decreasing  the 
error  tolerance  by  a  factor  10  implies  almost  halving  the  mean  time  step,  in  accordance  to 
the  predictions  of  equation  (102)  (actually,  the  e.^act  relation  is  10*^^  =  2.15). 


1  0.3071  --O-OTir 

0.1  0.0331  0.0349 

0.01  0.0042  0.0177 

0.001  0.000413  0.P0S2 
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Fiytire  6  -  Horizontal  (cont.  line)  and  vertical  (dashed  line) 
displacements  at  the  pendulum  extreme. 

Figures  6  and  1  display  the  evolution  of  displacements  and  accelerations  at  the  e.\treme 
of  the  pendulum.  We  can  see  that  there  .appear,  some  slight  perturbations  in  the  computed 
accelerations.  Ii^figure  8  we  represent  the  evolution  of  the  Lagrange  multiplier,  which 
evidence  some  perturbations  at  the  same  time  instants  than  the  accelerations  do.  If  we 
ait^yM  now  the  evolution  of  the  time  step  (figure  9),  we  recognize  that  these  perturba¬ 
tions  hre  Msocia^ed  to  changes  in  the  step  size,  in  complete  accordance  to  the  theoretical 
predictions. 
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figure  7  -  Horizontal  (cont.  line)  and  vertical  (dashed  line) 
accelerations  at  the  pendulum  extreme. 


Figure  S  -  Evolution  of  Lagrange  multiplier. 

5.  Concluding  Remarks 

The  paper  discussed  the  application  of  second  order  implicit  time  integration  schemes  to 
the  integration  of  the  equations  of  motion  in  constrained  dynamics  simulation.  The  aspects 
of  stability,  conditioning  of  equations,  accuracy:  and  time  step  control  have  been  analyzed 
in  detail.  Numerical  e.xamples  describing  the  main  issues  of  the  developed  algorithms  have 
been  shown.  The  algorithms  evidenced. global  quadratic  convergence  rate  in  all  variables, 
in  complete  accordance  to  the  theoretical  predictions. 
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Abstract 

The  numerical  solution  of  the  diiferential-algebrsic  equatiori>  of  motion  of  mechan¬ 
ical  systems  offers  many  .computs^tional  chidlenges.  In  this  paper  we  describe  progress 
which  has  bMn  m^e  in  understending  the  formulation  of  the  equations  of  motion  from 
the  vie«ri)o>ht  of  numeric^  stability,  ouUihe  some  of  the  difficulties  which  must  be  re¬ 
solved  for  ^icient  and  reliable  hmerical  methods  in  resl-tiihe  simulation  of  mechanical 
systems,  anil  propose  some  solutions. 

1  Introduction 

In  recent  yeus  much  ^tiyity  has  been  devoted  to  the  development  of  numerical  methods  and 
underlying  theory  for  the  solution  of  .differential-algebraic  ,  equation  (DAE)  systems.  These 
types  of  systems  occur  frequently  as  iiurisd  ^ue  problems  in  the  computer-aided  design 
and  mod^ng'of 'mecfwical  systems  subject  to  constraints,  electric^  networks,  chemically 
reacting  systems  su^.u  ^stUlsytibni  flow  of  incompressible  fluids,  and  in  many  other  appli- 
catiohsl  Differenti^-idgebraic  systems,  wlricH  in  graeral  can  tsdce  the  form  F{t,y,y')  —  0, 
are  different  from' stimdard-fbrm  OpE  systems  ^  =,/(t,y).in  that,  while  they  include  ODE 
systems  as  a  specif  case,  they  also  ihdude  problems -wluc^.ue  quite  different  from  ODEs. 

In  a'sense,  the  ihdre  singular  a  DAE  system  is,  the  more  difficult  it  is  to  solve  numerically. 
The  index  of  a  DAE  system  is  a  measure  of  the  de^ee  of  singulwty  of  the  system.  Roughly 
spukihg,  "ODE  systems  y'.  =  f{t,  y)  are  ind»  zero,  diflWential  equations  coupled  with 
algebraic  constraints,  y'  =  f{y,x),  0  =  p(y>2),  where  dg/dz  is  nonsingular,  are  index 
one,  and  differentia  equatipns  coupled  with.algebraic.constraints  where  z  cannot  be  solved 
for  uniquely  in  p  as  a  function  .of  y  are,  of  index  higher  thw  one.  The  index  can  be 
defined^  ^s6  lor  systeins  whid  are  not  expressed  in  the  semi-expUcit.  form  of  differential 
equations  coupled  with  dgebrmc  constraints.  Adffitiohal  difficulties  can  occur  for  these 
systems  because  the  singularity  may  be  moving.from  one  put  of  the  system  to  another. 

*ThU  work  wm  partially  lupported  by  the  U.S.  Army  Research  Office  contract  number  DAAL03-89-C- 
0038  with  the  University  of'Minnesota  Army  High  Perfonnuce  Computing  Research  Center,  and  by  ARO 
coiiitact  number  pAAL03-92-G-0247  and  DOE  contract  number  DE-FG02-92ER25130. 
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Much  progress  has  been  made  on  understanding  the  underlying  structure  and  numerical 
solution  of  DAE  systems.  Fundamental  concepts  such  as  index  and  solvability  have  been 
extended  to  classes  of  DAEs  describing  a  broad  range  of  scientific  and  engineering  problems. 
Convergence  results  have  been  given  for  numerical  methods  such  as  multistep  and  Runge- 
Kutta  appliedito  several  importMt  classes  of -DAEs.  Production-level  computer  codes  such 
as  DASSL  [7j  have  been  employed  extensively  for  the  solution  of  (index-one)  engineering 
problems.  Much  of  this  work  is  described  in  the  recent  monographs  [7,  25,  26]. 

There  is  much  still  that  needs  to  be  done  for  the  effective  solution  of  certain  classes  of 
DAEs.  In  this  paper  we  will  focus  on  the  algorithms  and  analysis  which  are  needed  for  the 
effective  real-time  simulation  of  mechanical  systems.  ^Real-time  simulation  of  mechanical 
systems  is  needed  in  robotics,  as  u  in  the  dm^  ud  simulation  of  vehicles,  including 
automobiles,  high-speed  trains,  tanks  and  construction  equipment. 

The  modeling  of  multibody  systems  gives  rise  to  Euler-Lagrange  equations.  Any  effective 
numerical  method  for  these  systems  must  be  very  fast  and  extremely  robust  because  the 
systems  must  often  be  solved  repetitively  by  design  engineers  who  do  not  have  time  to 
develop  a  working  knowledge  of  complex  computer  software  or  numerical  methods.  For 
soihe  important  applications  such  as  vehicle  simulation  and  design,  the  systems  must  be 
solved  in  real-time. 

Euler-La^Mge  equations  are  usuaHy  posed  initially  in  the  fonn  of  a  system  of  differ¬ 
ential  equations  (Newton’s  laws  of'motibh)  coupled' with  nonlinear,  constraints  which  are 
enforced  via  a  Lagrange  muitlplitr.  Direct  discfetizatidh  of  this  index-three  system  yields 
numerical  methods  which  are  often  not  very  robust  because  of  well-known(7]  difficulties  with 
error  estiniation  and  stepsize  control,  as  well  as  severe  ili-conditioning  of  linear  systems  at 
each  time  step  and  other  problems.  A  wide  variety  of  reformulations  of  the  problem  and  as¬ 
sociated  numerical  methods  have  been  suggested  in  an  attempt  to  find  a  system  of  equations 
describing  the  system  which  can  be  effectively  solved  numerically.  However,  each  has  some 
appatfentVdisadvMtage  in  tefins  of  speed  and/or  robustness.  Becauw  the  constraints  are 
sometimes  highly,  nonlinear  and  have  a  strong  physical  rele^ce,  it  is  generally  considered 
impoftant'that  the  ebns  :raints,  and  sometimes  the  time  derivative  of  the  constraints,  be  sat¬ 
isfied  very  accurately.  In  adffitioii,  jh«e  ate  other  potential  difficulties:  the  constraints  can 
become  rsinkrdefident  or  reaily  rai^.-deficient,  the  solution  may  have  components  which  are 
oscillating  at  a  high  frequency.  'and  th«his  the  possibility  of  fr^ueht  discontinuities  which 
are  especially  .troublesome  because  the  solution  of  a:  lugh-iudex  DAE  can  be  less  continuous 
than  its  inpuU  -Re'al-time  simulation  imposes  severe  requirements  da  the  solution  method. 
The.sdlutidh'inust  be  corapu^d  ecftemely  rapidly,  necessitating  the  use.of  massively  paral¬ 
lel  computers;  The  chsdlen'geTdr  multibody  systems  « to  develop  a  problem  formulation  and 
asrociated  dass'df  nuiiieri^  methods  which  preserves  the  stability  of  the  system,  ensures 
that  the  constraints  are  sati^edj  adapts  to  possibly  rapid  or  discontinuous  changes  in  the 
solution  M'd  to  nearly  fank-d^aent  cohstraihlsi  Md  accomplishes  this  task  in  an  absolute 
minimum  of  computer  time  and  extrmdy  reliably,  i  Section  2  we  will  outline  some  recent 
rMults  on  the^stable  formiilrtion  oLthe  equatiolis  of  motion,  for  niimeried  solution,  and 
in  Section  3  we  will  outline  some  of  the  cbmputatidnai  chalienges  for  efficient  and  reliable 
nuinefical -methods,  and  propose  some  solutidns. 


2  Stable  Formulations  of  the  Equations  of  Motion 

In  this  section  we  will  be  concerned  with  formulations  and  numerical  methods  for  the  Euler* 
Lagrange  equations  of  constrained  mechanical  motion.  These  are  systems  of  the  form 

^(^P)P  =  /(<.P.»») -<?(«,  P)^^  (la) 

0  =  p(<,p)  (lb) 

where  the  positions  and  velocities  satisfy  p,  u  €  SH"',  and  M(p)  is  a  x  Up  regular  (sym¬ 
metric  positive  definite)  mass  matrix,  /  is  a  vector  of  applied  forces,  and  A  represents  the 
Lagrange  multipliers  or  constraint  forces  coupled  to  the  system  by  the  x  constraint 
matrix'  G  :=  dg/dp.  These  types  of  systems  arise  frequently  in  the  modeling  of  multi¬ 
body.  syhems[27];  for  example  in  vehicle  simulation,  computer-aided  design  of  mechanical 
systems,  and  modeling  of  robotic  m^pulatbrs. 

The  Euler-Lagrahge  system  (1)  poses  difficulties  for  numerical  methods  in  part  because 
it  is  index-three.  In  particular,  direct  discretization  of  (1)  yields  numeric^  methods  which 
axe  often  not  very  rbbust  becauM  of  the  well-known[7]  difficulties  for  higher-index  systems 
withrenor.estimation  and  stepsize  control,  as  weU  u  severe  ill-conditioning  of  the  linear 
systems  at  each-time  step,  and  a-variety  of  other  problems.  In  addition,  for  some  problems 
the  constraints  can  be  poorly  conditioned;' in  these  cases  methods  applied  to  (1)  and  to 
rome  of  its  reformulations  can  behave  numerically  as  if  they  were  solving  a  problem  for 
which  the  index- is  even  higher. 

To:oyerc6me  the  problems  inherent  in  the  direct  numerical  solution  of  the  index- three 
form  of  the'Euier-Lagrange  ^nations,  quite  a  number  of  reformulations  of  (1)  have  been 
suggested;  some  are  in  use  in  multibody  codes  [48].  Many  of  these  formulations  of  the 
equations  are  based'bn  differentiation  of  the  constraints.  The  constraints 


o 

11 

(2a) 

0  =  G{p)v 

(2b) 

0  =  G(;i)v-f  r^Gp(p)w=:  G(p)v  +  z(p,u) 

(2c) 

are  called  the  position,  velocity,  and  daxlention-level  constraints,  respectivdy.  An  index- 
two  problem  can  be  formed,-  fdr'^ainpie,  by  replacing  the  position  constrmnt  in  (1)  with 
the  velocity  constraint;  The  resulting  problem  has,  with  appropriate  initial  conditions,  the 
same  solutions  as  (1)  and  is  somewhat  easier  to  solve  numerically.  However,  the  solutions 
can^dnyif'away  ffbni  satisfying  the  position  constraints^  because  of  numerical  errors  at  each 
'time;step.  This-drift  is  often  considered  unacceptable  in  engin^rihg  problems  because  of 
the  strong  physical'relevahce  of  the  pbsitioh-cohstraihts  ( th^e  are  often  holding  components 
together),  and  because  of  their  sometimes  severe' honllhearity.  An. index-one  problem  can 
be  formed  by.repladhg  the  position  constraint 'in  (1)  with  the  acceleratiqn  constraint.  The 
resulting.^systemris'generally  much  easier  tp  soive  numerically,  but  now  the  solution  can 
drift  away-froin  both  the  poatioh  ud  velocity  constraints;  the  drift  away  from  the.ppsition 
constraiht  can  be  quite  righif.cwt. 
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V'arious  formulations  and  solution  procedures  have  been  proposed  to  deal  with  or  elim¬ 
inate  the  problem  of  drift.  Gear  and  others  [22]  have  suggested  that  instead  of  replacing 
the  position  constraint  with  the  velocity  constraint,  both  constraints  could  be  explicitly 
enforced  by  means  of  an  additional  Lagrange  multiplier.  This  leads  to  a  system  of  the  form 


p  =  v~G^{t,p)fi  (3a) 

M(t,p)v  =  /(f.p.v)^  {?’■(!, p)A  (3b) 

0  =;  9(j>)  (3c) 

0-  «  G(p)»  (3d) 


The  resulting  problem  is  ind»-two.  There  is.a  similar  formulation  which  enforces  addition- 
ahy  the  accel»ati6n  constraint  by  means  of  yet  pother  Lagrange  multiplier.  These  types 
of  systems  are  generally  called  stabilized  formulations  of  the  Euler-Lagr^ge  equations  (as 
opposed  to  the  unstabilized  forms  discuss^  eafhn~for  which  there  may  be  drift).  Although 
the  sthbiiized  fonnulatiohs  quite  cleverly  dimlnate  the  drift  problems^  we  have  unfortu¬ 
nately  found  in. fecmt  numerical  ^eriments  that  most  ODE  methods  (including  BDF 
and.mpst.im^liat  Rung^Kutta)  applied  to  theiM  equ^tipnsmay. became  very  inefficient  in 
certiuh  situations,  foh.example  if  the.system  is  heterogeneous  (includes  components  with 
widSy  ffisparate  mas^)  or  the  constfimts-ue  poorly  conditioned. 

^uatioh'(i)  hu  m  s'hp .de^eM  ofneedom.  Using  the  constraints,  we  can  reduce 
(1) 'Ideally  to  a  syhem  of  m  DDEs  dallM  a  state-space  fom.  The  choice  of  coordinates 
is  not  unique^,  Haug  and  Wehage  [52]  .use  Cutesian  coordinates.  The  resulting  method  is 
called  yenera/ized  cpofdmdiepartttiontnyiUdiiiLthe  basis  qfthecodeDADS  [48].  Potraand 
^eihl>oIdt(44, 45] 'surest  a  ffiffefent  16^  puamrtemation.  For  the  pun>oses  of  analysis, 
we  will  propose  to  define  w  essential  undeifj/ing  ODEfiii^ck  is  a  certain  class  of  state-space 
forms.  By  its  construction,  the  original  constraints  are  satisfied  by  a  state-space  form.  The 
same  set  of  coordinates  may  not  work  over  an  entire  problem;  thus  the  coordinates  must  be 
chosen  adaptively. 

Still  another  possible  method  for  solving  the  .Euler-Lagrange  equations  consists  of  ap¬ 
pending  the  velocity  and  aceSefation  ednstfaihts  to  (i).  The  resulting  system  is  called  an 
overdetermined  DAE  (ODAE),  wd  has  been  investigated  by  Fuhrer[17]  and  Leimkuhler[18], 
and  dthers[41].  The  ODAE  is  dlscretiud  by  a  numerical  method  su^  as.BDF.  and  the  re¬ 
sulting  no^hev  system  isMy^  by  a  Gauss;Newtpn  iteration..  In  [i8].it  is  shown  that  for  a 
model  problem  where  the  constrmnts  are  linev  with,  constwt.froefficirats  and  under  certain 
other  cdhffitions,  the  sojutipii  to  the  ODAE  which  is  'deternuned.using  a  ceitaia  ssf-itemtion 
to  solve  the  noinlihear  system  is  the  5^e;ju  that.pbt'wied.by  solving  one  of  the  stabilized 
-forms,  and  that'theM  sblutidhs  afs  eqiuyalrat  tothose  qhtained  .by  numerically  integrating 
the  sthte-spade  form  usihg.the  same  discrethatipn  method.  -Uhfortunatdy,  these  results  do 

nolS^peartp^canydvcrtpthemoregene^Xye-.  ; 

Varidus'^ther 'methods  have  .bMn'propu^rfpr  splying  the  Euier-Lagrange  equations, 
induffihgthe're^arizatidnsdf  Baumgarte[6],  Ldtitedt[29],.K^achey  ,^d  6-MaUey[28],  and 
others:  Sometimes  these  r^ulanzatipns  can  be  qu|te  ^setive;  Rations  of  the  method  of 
Baiimgarte  afe^in  use'in  many  engineering  codes.  Untortunately,.it  is  hot  always  easy  to 
pidc'the  re^lidizatioh  puameters  which  work. 


As  we  have  seen,  a  wide  variety  of  formulations  and  associated  numerical  methods  have 
been  suggested  for  the  solution  of  the  Euler-Lagrange  equations  of  constrained  mechanical 
motion.  In  recent  work  [2],  we  have  systematically  evaluated  the  formulations  and  associated 
numeri^  methods  from  the  standpoint  of  stability,  to  determine  whether  some  formulations 
and  methods  are  inherently  better  at  preserving  the  conditioning  of  the  original  problem 
than  others.  The  basic  idea  is  to  define  a  class  of  essential  underlying  DDEs  (EUODB). 
The  EUODE  is  defined  for  higher-index  linear  Hessenberg  DAEs  of  the  form 

m 

j(m)  _  Y^AjZjTBy-\  q  (4a) 

0  =  Cx  +  r  (4b) 

where  z{x)  =  (a:,2',...,i^*"*^)^,  Aj^  B  and  C  are  smooth  functions  of  t,  0  <  t  <  1, 

Aj(l)  €  R"**"*,  j  =  B(t)  €  R"**”*,  and  CB  nonsingular  for  each 

t  (this  azures  that  the  DAE  has  index  m  +  1)-  All  matricu  involved  are  assumed  to 
be  uniformly  bounded  in  norm  by  a  constant  of  moderate  size.  The  inhomogeneities  are 

.9(0  €  R“V“d  r(0  ^ 

The  EUODE  is.  derived  as  follows.  M  in  [1].  there  exists  a  smooth,  bounded  matrix 
function  B(t)  €  R("*”"»)*"»  whose  linearly  independent  rows  form  a  basis  for  the  nullspate 
of  8“^  (R  cw  be  taken  to  be  orthonorm^).  Thus,  for  each  6  <  (  <  1, 

RB  =  0  (5) 

We  assume  that  there  ensts  a  constant  ■A'l  of  moderate  size  such  that 


|i((7B)-»||<A, 


(6) 


uniformly  in.  (,  and  obtain  (Lemma  2.1  in  [1])  that  there  is  a  constant  K2  of  moderate  size 
such  that 


(7) 


The  constant  K2  depends,  in  addition  to  K\,  also  on  ||£||,  ||(7jj  and  ||JZ||.  Let  Kz  be  a 
moderate  bound  on  R  and  its  derivatives; 


Define  new  variables 


i  =  0,l . m 

(8) 

tt  =  ifcr,  0  <  f  <  1 

0) 

Then,  using  (4b),  the  inverse  transformation  is  given  by 


where  o(t)  6  R'**’'^"*”’**)  satisfies 


(10) 


f 

\ 


F  :=  S(C5)-*  (12) 

By  our  assumptions  and  (7)  this  mapping  is  well-conditioned.  Both  S  and  F  are  smooth 
and  bounded.  The  first  m  derivatives  of  S  and  F  are  bounded  by  a  constant  involving  j\ i 
and  K3.  Taking  m  derivatives  of  (dl  ^..alds 

Using  m  -  1  derivatives  of  (10)  we  ob  ain  the  I'vfOo^. 

u(")  =  +  (  ■ !!  1  j  -  (^’r)<'-‘>l  +  Rq  (14) 

The  EU'.'DEs  i.  f  a.  syt.i  a  are  ceit  y^.  state-space  forms  which  are  uniquely  defined  up  to  a 
bounded,  nonsirrular  change  of  vp^  .  ft  is  shown  [2]  that  if  the  EUODE  is  stable,  i.e. 
if  its  Green ’u  /.n .:  yo  is  bounded  b>'  t  c  ..^rant  of  moderate  size,  then  a  similar  conclusion 
holds  for  the  n.  <;  J  1/AE.  Since  the  uoundedness  of  the  Green’s  function  is  invariant 
under  bou'ded,  !i.  asiugular  rhanfcs  of  variables,  the  question  of  stability  for  the  EUODEs 
is  well-df  fim-d.  '.  t  [2],  we  used  .'b?  E  wCOE  to  investigate  'he  stability  of  some  of  the  many 
equatiof.  fonr.-  Ut!on«  ft  r  Euler-L^rrAi  ^.  systems.  V  c  found  that  all  of  the  formulations 
preserved  he  tabl  'f  “xcept  •’ns*. , .  it*" ^iduttion. 

While  se  '  ...  ^■".erer'.t  eqa?*tioe.  .e.'m*'  ■.* .!  r  •.''i.>t  equally  preserve  the  conditioning  of 
the  Euler-1  j.^«ige  : ,  the  properties  numerical  methods  applied  to  these  systems 

are  often  quite  different  For  example,  it  le  w«>if  known[7]  that  higher  index  systems  are  in 
a  sense  ill-posed,  and  cut  lead  to  ditficulties  for  cumerical  methods  with  error  control,  ill- 
conditioning  of  linear  systems  at  each  time  step,  etc.  For  higher-index  Hessenberg  DAEs 
such  as  the  Luler- Lagrange  equations,  the' t  is  a  problem  with  numerical  instability  for  many 
methods.  Consider,  for  exarnple,  a  linear  bomogeneiius  Hessenberg  index-two  system 

*'  =  A(t)x  +  B{t')y  (1.5a) 

0  =  C(t')x  (15b) 


This  system  has  the  EUODE 


u'  =  RASu  :  R'Su 


Now  discretize  with  implicit  Euler 


2n+i  =  x„  +  hA„+lX„+^  +  hB„+iyn+i 
0  =  Cn+l^n+l 


'Dransforming  back  to  the  variables  of  the  EUODE  yields  the  discretization 

Wn+l  =  u„  -f  hRASUn+1  +  hR'SUn  (18) 

Comparing  (18)  with  the  EUODE  (16)  shows  that  the  implicit  Euler  method  corrMponds 
to  a  discretization  of  the  E  JODE  which  handles  the  term  R'Su  explicitly]  Thus,  although 


y;, : 


I  .  'f- 


convergence  results(7]  predict  that  tUs  method  will  converge  globally  to  0{h),  there  is  a 
problem  with  respect  to  numerical  stability  which  restricts  the  stepsize  when  R'S  is  large. 
This  problem  is  verified  by  experiment;  there  is  very  definitely  a  nonstiff  behavior  of  meth¬ 
ods  ranging  from  BDF  to  most  implicit  Runge-Kutta  for  certain  stable  linear  Hessenberg 
index-two  systems.  On  the  other  hand,  it  is  possible  to  argue,  with  a  finer  analysis,  that 
under  ‘reasonable’  conditions,  this  type  of  numerical  instability  should  not  occur  for  certtun 
projections  (for  example,  in  (17)  if  J9  =  C^).  The  best  cure  for  this  numerical  instability 
seems  to  be  to  reformulate  the  system  in  a  form  for  which  the  instability  cannot  occur. 
This  is  done  by  reformulating  the  system  in  a  form  where  the  projection  can  be  controlled, 
rather  than  dictated  by  the  M  matrix.  In  particular,  we  would  like  to  formulate  the  system 
so  that  B  =  C^.  We  call  these  formulations  the  methods  of  ‘projected  invariants’.  The 
methods  are  constructed  as  follows: 

1.  Starting  with  the  original  Euler-Lagrange  equation,  use  the  acceleration  constraint 
to  eliminate  A  and  obtain  an  ODE  in  p,  v  which  has  as  invariants  the  position  and 
velocity  constraints; 

p  =  V  (19a) 

V  =  (I-H)M-^f-Fz{p,v)  (19b) 

where  F  =  Af-‘G^(GA/->G^)-‘,  and  .ff  =  FG. 

2.  Project  the  solution  onto  the  desired  invariants  using  G^  or  other  stable  projection. 
For  example,  project  onto  the  position  constraints: 

p  St  v-G'^p  (20a) 

V  =  {I-H)M-'^f-Fz{p,v)  (20b) 

0  =  s{p)  (20c) 
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3.  Note  that  the  above  system  has  the  same  numerical  solution  as  the  following  implicit 
formulation  which  can  be  implemented  more  efficiently: 

p  ~  V-  G^p 

Mv  =  /(p,  v)  -  G^X 
0  =  Gv  +  z{p,  u) 

0  =  g(p) 

Depending  on  whether  we  do  the  projection  onto  the  position  constraints  alone,  or  onto 
the  position  and  velocity  constraints,  this  leads  us  to  two  forms  of  projected  invariants 
methods  for  constrmned  mechanical  systems: 

1.  Project  onto  position  constraint; 

p  =  V  -  G^p 
Mi)  ss  f{p,v)-G^X 
0  =  -f  z(p,  v)  (acceleration) 

0  =  s(p)  (position) 
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2.  Project  onto  position  and  velocity  constraints; 


p 

=  V-  G^fi  -  L^r 

(23a) 

Mi) 

=  fip,v)-G^\-  MG^r 

(23b) 

0 

=  Gv+  r(p,  v)  +  GG^r  (acceleration) 

(23c) 

0 

=  Gv  (velocity) 

(23d) 

0 

=  ff(p)  (position) 

(23e) 

where  L  s  G^v.  These  equations  are  studied  in  more  detail  in  [41]  and  [3].  There  is  some 
controversy  over  whether  it  is  really  necessary  to  include  the  term  however  numerical 
experiments  in  [3]  seem  to  indicate  that  including  this  term  is  advantageous  for  numerical 
stability,  in  certain  cases  where  the  solution  is  oscillating  at  a  high  frequency. 

There  is  also  a  nice  geometrical  interpretation  for  the  method  of  projected  invariants  • 
it  corresponds  to  the  orthogonal  projection  onto  the  invariant  constraints  of  the  ODE. 


3  Computational  Challenges 

3.1  Efficient  solution  techniques 

Virtually  all  the  proposed  formulations  for  Euler-Lagrange  equations  have  a  similar  stnic* 
ture  with  regard  to  the  linear  systems  which  must  be  solved  at  each  time  step.  Even  the 
solution  of  a  state-space  form,  which  at  first  glance  might  seem  to  have  quite  a  different 
structure,  can  be  expressed  using  Lagrange  multipliers  in  a  form  with  this  structure  [44, 45). 
Thus  it  is  important  to  be  able  to  solve  efUdentiy  systems  with  this  structure.  There  are 
several  important  cases: 


3.1.1  Nonstiff 

In  the  nonstiff  case,  half-explicit  methods  [26,  33]  and/or  iterations  [18,  22,  43]  can  be 
devised  which  require  much  less  work  than  in  the  stiff  case.  There  is  still  a  linear  system, 

which  arises  because  of  the  constraints,  to  be  solved  at  each  time  step.  However,  the  matrix, 
/jlf  (jFx 

which  has  the  form  I  ^  ^  1 ,  has  some  nice  properties:  it  is  symmetric  positive  definite, 

and  it  does  not  depend  on  the  stepsize  or  order  of  the  discretization.  Further,  linear  systems 
of  this  form  have  been  studied  extensively,  e.g.,  In  constrained  optimization,  and  some  of 
these  algorithms  may  be  appropriate.  For  example,  it  may  be  feasible  to  update  the  matrix 
ot  its  decomposition  over  a  sequence  of  steps/iterations  by  quasi-Newton  updates.  Using 
the  matrix  as  a  preconaitioner  for  iterative  methods  such  as  GMRES,  the  linear  systems 
would  not  need  to  be  solved  very  often.  The  mechanical  systems  have  a  special  structure 
which  can  be  further  exploited;  for  example,  the  0(n)  methods  [46, 33]  can  be  used  to  solve 
the  linear  systems.  However,  this  method  leads  to  a  recurrence  which  seems  to  be  difficult  to 
parallelize[5].  We  are  studying  further  possibilities  for  parallelizing  the  recurrence.  Among 
the  problems  are  load  balancing  and  exploiting  parallelism  when  there  are  long  chains. 
To  some  extent,  it  may  be  possible  to  use  a  block  cyciic-reduction[36]-based  algorithm  to 
enhance  the  parallelization  for  long  chains. 
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For  many  systems,  for  example  if  the  stiffness  arises  because  of  a  controller,  only  a  small, 
readily  identifiable  part  of  the  system  may  be  stiff  [51].  Here  we  expect  that  the  GMRES 
iterative  method  [47],  with  the  appropriate  half-explicit  methods  as  a  precondit'oner,  should 
be  effective. 

3.1.2  Stiff 

Stiff  problems  can  arise  for  example  in  the  modelling  of  flexible  bodies  subject  to  constraints. 
In  the  fully-stiff  case,  the  linear  systems  to  be  solved  at  each  time  step  still  exhibit  a  special 
structure,  but  they  are  no  longer  symmetric  and  now  depend  on  the  stepsize.  For  example, 
the  stabilized  index-2  form  of  the  equations  of  motion  (3)  leads  to  the  linear  system 


-/ 

G^ 

0  \ 
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G^ 

r, 
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0  / 
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The  matrix  above  is  rather  large,  of  dimension  2np  -f  2n\,  and  its  LU  decomposition  is 
generally  dense.  If  the  number  of  constraints  is  of  the  same  order  of  magnitude  as  the 
number  of  positions,  methods  which  are  analogous  to  the  null-space  method  of  numerica' 
optimization  [24]  can  be  considered.  At  present,  we  do  not  have  sufficient  experience  to 
determine  whether  this  is  preferable  to  other  alternatives.  In  addition,  for  flexible  structures, 
the  considerable  structure  Inherent  in  the  linear  system  arising  from  the  discretization  should 
be  exploited. 

We  have  recently  developed  some  new  software  for  large-scale  DAE  systems.  The  new 
code  DASPK  [8],  combines  the  time-stepping  methods  of  DASSL  with  the  preconditioned 
iterative  method  GMRES  for  solving  the  linear  systems  on  each  time  step.  There  are  also 
two  new  parallel  versions,  DASPKMP  and  DASPKF90,  written  for  the  Thinking  Machines 
CM-5  in  message-passing  MIMD  and  data-parallel  SIMD  modes,  respectively  [35]. 

3.1.3  Automatic  stiffness  detection 

Many  problems  in  the  simulation  of  multibody  syste-ms  ue  nonstiif  (or  involve  only  a  very 
few  stiff  components,  as  described  above).  However,  stiff  problems  certainly  do  occur.  A 
robust  system  for  computer  aided  design  should  be  able  to  treat  both  types  of  systems, 
hopefully  with  no  intervention  from  the  user.  For  example,  it  is  possible  to  construct  a 
method  similar  to  those  whic^  have  been  proposed  and  implemented  for  ODEs  [40,  49, 
50],  which  monitors  the  convergence  of  the  iteration  and  automatically  switches  to  the 
appropriate  method.  To  see  how  to  do  this,  consider  the  index-two  model  system 


y'  =  f{Uy)  +  G^x 
0  =  g{t,y) 


(24) 

(25) 

where  dgfdy  =  G.  Suppose  that  the  problem  (25)  is  nonstiflf.  What  does  this  mean,  for  a 
DAE  of  this  form  to  be  nonstiff?  Differentiate  the  constraint  to  obtain  Gy'  -  0,  and  use 
this  to  solve  for  A  in  (25),  to  obtain 

A  =  -[GG'^)Gf 
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Now  plug  A  into  the  original  equation  (25)  to  obtain 


(26) 


where  H  =  G^(GG^)~^G  is  a  projector.  The  system  (26)  is  often  called  the  underlying 
ODE  of  (25).  We  will  say  that  (25)  is  stiff,  if  (26)  is.  A  test  of  stiffness  in  (26)  is:  if 


l|A(/- ■ff)/yll  »  1 


(27) 


for  a  stepsize  h  that  we  would  like  to  use,  based  on  accuracy  considerations,  then  the 
problem  will  be  considered  stiff. 

Here  is  how  the  automatic  method  switching  would  work.  When  the  problem  is  nonstiff, 
we  would  use  an  ap;-*'  ■  ih.-  -eration  matrix  (or,  in  combination  with  iterative 

methods,  a  preconittocc/i)  wLth  Ign.  t  the  part  of  the  matrix  corresponding  to  /y.  For 
(25),  this  is 

Pnonttijf  ~  0  ) 

As  mentioned  in  the  section  on  nonstiff  problems,  depending  on  the  structure  of  the  DAE 
there  are  a  number  of  ways  to  efficiently  solve  these  kinds  of  linear  systems.  We  start  out 
by  assuming  the  problem  is  nonstiff.  When  Newton,  (or,  in  the  case  of  iterative  methods 
like  GMRES,  the  iterative  method)  with  the  approjumation  to  the  iteration  matrix  given  by 
(28),  fails  to  converge  for  a  current  matrix  approximation,  it  must  be  because  the  problem 
Is  stiff.  To  see  this,  note  that  the  exact  iteration  matrix  is  given  by 


-f) 


Thus, 


P~*  J 


_(I-h{I-n)fy  OA 
-  V  I) 


where  M  =  (GG^)“*G.  If  the  problem  is  nonstiff,  then  is  small,  and  the  iteration 

should  have  no  trouble  converging.  If  the  problem  is  determined  to  be  stiff,  the  terms  in  the 
iteration  matrix  involving  /y  will  need  to  be  approximated.  Now,  suppose  that  a  problem  has 
been  determined  to  be  stiff  and  that  we  are  using  an  appropriate  (but  relatively  expensive) 
iteration  to  solve  it.  How  can  we  tell  whether  the  problem  later  becomes  nonstiff?  One 
possibility  is  to  monitor  ||/y||. 

3.2  Rank-deficient  systems 

It  can  sometimes  happen  that  the  constraint  matrix  G^  becomes  rank-deficient  or  nearly 
rank-deficient[37,  14].  There  are  a  number  of  possible  situations.  The  matrix  ran  be 
of  constant,  but  reduced,  rank.  This  is  the  case,  for  example,  if  you  model  a  table  with 
four  legs.  Then  some  of  the  Lagrange  multipliers  are  not  uniquely  defined.  However,  the 
positions  and  velocities  are  well-defined  (30).  For  other  problems,  G^  may  lose  rank  only 
locally,  and  then  there  axe  a  number  of  possibilities.  In  some  cases,  the  positions  and 
velocities  are  well-defined,  while  some  of  the  Lagrange  multipliers  are  not  unique.  It  can 


I 
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also  happen  that  the  solution  fails  to  exist  following  the  singularity.  This  latter  situation  is 
analogous  to  impasse  points  which  have  been  studied  in  electrical  engineering  [11, 12]. 

There  are  a  number  of  possibilities  for  dealing  with  singularities  in  the  constraint  matrix, 
in  situations  where  the  positions  and  velocitias  are  well-defined.  By  considering  the  DAE 
in  terms  of  a  problem  of  minimizing  the  deviation  of  the  constraint  functions,  subject  to 
the  differential  equations,  the  well-known  Baumgarte  stabilization  can  be  obtained  [42], 
for  well-conditioned  constraints.  This  derivation  also  yields  a  strategy  for  selecting  the 
Baumgarte  parameter.  When  the  constraints  are  poorly  conditioned  or  not  of  full  rank, 
a  model  trust-region  approach  [10]  can  be  used  for  the  optimization.  This  regularizes  the 
DAE,  introducing  a  term  which  is  small  except  locally  near  the  singularity.  Our  experience 
so  far  with  the  trust-region  regularization  has  been  favorable;  there  are  some  analytical 
results  to  justify  this  approach.  Another  regularization  has  been  suggested  by  Park  and 
Chiou  [37]. 

3.3  Discontinuities 

Frequent  discontinuities  are  possible  in  a  multibody  system.  Some  of  these  discontinuities 
will  be  located  very  efficiently  by  a  root-finder  such  as  in  DASSLRT]?].  However,  others  may 
arise  from  user-defined  functions  or  other  unanticipated  situations,  and  need  to  be  located 
automatically  and  handled  efficiently.  In  the  case  of  a  collision,  conservation  properties 
of  the  solution  should  be  preserved  across  the  interface.  The  situation  for  DAEs  presents 
difficulties  in  addition  to  the  ODE  case  because  the  solution  of  a  high-index  system  can 
be  less  continuous  than  the  input,  and  singularities  in  the  system  can  lead  to  numerical 
behavior  which  is  quite  similar  to  that  caused  by  discontinuities.  Impulsive  solutions  are 
possible. 

3.4  Highly  oscillatory  systems 

Often  in  multibody  systems  the  solution  may  have  components  which  are  oscillating  at  a 
high  frequency.  This  is  a  problem,  for  example,  in  vehicle  suspension  models.  In  a  numerical 
method  such  as  multistep  or  Runge-Kutta,  which  are  based  on  approximating  the  solution 
locally,  the  stepsize  must  be  chosen  very  small  to  resolve  the  oscillation  in  the  solution, 
even  if  the  amplitude  of  the  oscillation  is  very  small  and  does  not  significantly  influence 
the  long-term  solution  behavior.  We  have  been  working  on  efficient  numerical  methods  for 
these  systems.  On  first  glance,  one  might  think  that  it  would  be  possible  to  determine 
the  local  elgenstructure  of  the  system,  and  then  propagate  the  solution  by  methods  based 
on  matrix  exponentiation.  This  would  have  a  large  cost  per  step  but  it  could  be  made 
more  efficient  by  using  Krylov  methods  like  GMRES  to  approximate  the  space  of  the  high- 
frequency  eigenvalues,  rather  than  finding  all  of  the  eigenvalues  of  the  system.  However,  in 
experiments  with  a  stiff  spring  pendulum  model  problem,  we  found  that  unless  one  started 
almost  exactly  on  the  smooth  (not  the  high-frequency)  solution,  the  local  eigenvalues  do  not 
lie  on  the  imaginary  axis,  as  you  might  expect  for  a  high-frequency  oscillation,  but  instead 
may  have  large  positive  and  negative  real  parts,  causing  the  method  to  go  unstable.  We  are 
currently  looking  into  damping  out  the  oscillation  when  its  amplitude  is  small  via  BDF  or 
other  strongly  damped  methods.  Lubich  [34]  has  studied  this  problem  for  certain  Runge- 
Kutta  methods,  and  gives  convergence  results.  However,  there  are  a  number  of  difficulties 


in  constructing  a  robust  higher-order  method,  and  it  remains  to  be  seen  for  problems  in 
applications  whether  the  cost  of  solving  a  nonstiif  problem  by  an  implicit  method  like  BDF 
can  be  brought  down  sufficiently  via  iterative  methods  (although  we  suspect  this  will  be 
true  if  the  number  of  high-frequencies  is  substantially  smaller  than  the  size  of  the_system). 
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Abstract:  The  emergence  of  high*tpeed  computers,  new  mechanical  system  dynamic  •! 

simulation  formulations,  and  a  broad  tinge  of  operator-in-the-loq>  simulators  is  shown  to  \ 

provide  a  revoludonaiy  new  virtual  prototyping  tool  to  support  Concurrent  Engineering  of 

mechanical  systems.  The  state*of>the'an  of  operator*in-the-loop  simulation  and  projections  ■. 

regarding  its  refinement  for  use  in  a  broad  range  of  engineering  applications  is  outlined,  with 

emphasis  on  providing  a  viimai  prototyping  capability  that  accounts  for  the  operatcr>macbine 

interaction,  prior  to  fabrlcadon  and  test  of  prototypes.  Examples  of  advanced  ground  vehicle 

simulators,  telerobodc  simulaiors,  and  construction  equipment  simulators  are  used  to  illustrate 

virtual  prototyping  applications  that  hold  the  potential  to  revolutionize  the  process  of 

mechanical  system  design  for  the  human  operator.  The  potential  now  exists  to  routinely  > 

investigate  trade.ofis  involving  mechanical  system  design  and  operator  effecuveness  that  will 

permit  the  engineering  community  to  optimize  the  design  of  mechanical  systems  for  the 

human  operator,  beginning  early  in  the  design  and  development  process  and  continuing 

through  commerdaliutioD  and  product  improvement.  Bringing  the  human  factor  into  design  ; 

considendon  using  virtual  prototyping  before  design  decisions  are  finalized  is  projected  to  be 

one  of  the  greatest  advances  in  Concurrent  Engineering  of  Mechanical  Systems  to  occur  in  j 

the  decade.  ^ 


Keywords:  virtual  prototyping  /  operator*in>the>ioop  simulation  /  real-dme 
dynamic  simulation 


1  Introduction 


Dynamic  simulation  of  mechanical  systems  has  seen  a  renaissance  during  the  1980s,  due  to  a 
nui;.jer  of  synergisdc  developmenu.  The  rapid  increase  in  digittl  computer  power  has 
permitted  an  ihtemadonil  community  concerned  with  mechanical  system  dynamics  to  create 
new  analytical  and  compuutional  formulations  that  take  advantage  of  emerging  computer 


power  and  autoimte  the  proceas  of  forming  and  solving  the  differemial-algebraic  equations  of 
mechanical  system  dynamics,  using  only  engineering  model  data  that  can  be  naturally  and 
effectively  provided  by  the  engineer.  With  this  computarional  burden  transferred  from  the 
engineer  and  analyst  to  the  computer,  the  creative  process  of  model  development,  design 
concept  formulation  and  analysis,  and  testing  of  designs  prior  to  fabrication  of  a  prototype  has 
revoludonized  the  process  of  mechanical  system  design  for  dynamic  performance  [1-6].  As 
an  illustration  of  the  explosive  grovnh  in  the  field  of  mechanical  system  dynamic  simulation, 
six  textbooks  and  advanced  research  monographs  on  the  topic  have  been  published  since 
1988  [7*12],  whereat  only  two  such  books  had  been  published  prior  to  1988  [1 3. 14], 

As  impressive  as  has  been  the  advancement  in  computer-based  dynamic  simulation  of 
mechanical  systems,  computer  times  required  for  realistic  simulation  of  dynamic  performance 
of  mechanical  systems  have  been  extremely  high.  Even  on  the  most  powerful  computers 
available  in  the  late  I980i,  the  computer  time  required  has  typically  been  a  factor  of  10  to  100 
greater  than  the  clock-tune  that  transpires  during  actual  motion  of  the  mechanical  system.  As 
a  result,  only  off-line  (non-real-time)  dynamic  simulation  could  be  carried  out  in  support  of 
design  applications,  precluding  applications  in  which  the  operator  must  interact  with  the 
mechanical  system  to  control  performance.  Projections  of  increased  computer  performance 
and  the  emergence  of  revolutionary  new  dynamics  formulations  in  the  late  1980s  suggested 
the  potential  for  real-time  simulation:  i.e.,  computing  the  motion  of  a  mechanical  system  in 
one  unit  of  the  computer  time  that  corre^onds  to  the  same  unit  of  time  required  for  actual 
performance  of  the  system.  This  led  to  a  vision  for  operator-in-the-loop  simulation  for  a 
broad  range  of  applications  in  the  late  1980s  that  is  only  now  coming  to  fhuuon.  The  purpose 
of  this  paper  is  to  summarize  the  development  of  enabling  technologies  for  operator-in-the- 
loop  simulation,  providing  references  for  more  detailed  developmenn  The  role  of  operlIo^in• 
the-loop  simulation  is  defined,  to  permit  concurrent  consideration  of  the  hurrran  operator  in 
design  of  mechanical  systems,  beginning  in  the  conceptual  design  phase  and  continuing 
through  production  and  product  improvement  This  new  capability  might  be  thought  of  as 
prototyping  and  testing  designs  on  the  simulator  with  the  operator-in-the-loop,  suggesting  tiie 
term  "virtual  protoQ^ting." 

A  precise  definition  of  the  term  "virtual  prototyping,"  especially  as  it  applies  to  mechanical 
system  design,  is  needed  to  avoid  confusion  with  other  concepu  in  design.  As  a  foundation 
for  such  a  definition,  consider  the  following  dictionary  definitions: 

Prototype;  A  first  full-scale  functional  form  of  a  new  type  or  design  of  a  construction 
(such  as  an  airplane). 

Virtual:  Being  such  in  essence  or  efiiect,  although  not  in  actual  fact. 

Reality:  The  quality  or  fact  of  being  real. 

While  not  yet  in  the  dr'iwnary,  the  term  "virtual  reality"  has  taken  on  the  meaning  of  the 
"computer  generated  perception  of  reality  on  the  pan  of  an  involved  human."  It  is  believed 
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ihai  the  lenn  "vinual  reality"  motivated  the  emerginf  use  of  the  term  "virtual  protots’pe," 
suggesting  both  computer  and  human  involvement  in  vinual  prototyping. 

A  key  concept  that  is  implicit  in  each  of  the  above  definitions,  but  not  explicitly  stated,  is 
that  the  functionality  of  the  system  or  environment  being  addressed  is  clearly  understood. 
The  functionality  of  a  prototype  is  censal  to  the  purpose  for  which  it  is  fabricated  and  tested; 
e.g.,  assessment  of  dynamic  performance,  maintainability,  manufacturability,  and 
supporuUlity.  Ihe  expression  "being  such"  in  the  deiinition  of  the  word  "virtual"  implies 
some  well  understood  form  of  functionality.  The  essence  of  the  concept  of  "reality"  is  that 
some  form  of  functionality  should  be,  or  ^pear  to  be,  real.  Thus,  the  central  issue  in 
defining  and  using  the  term  "virtual  proto^ping "  it  making  explicit  the  intended  functionality 
of  the  prototype  that  it  to  be  KaUsed  virtuiUy. 

\^thdiis  background,  the  following  deflititiont  are  proposed:  . 

Virtual  Prototype:  A  computer  based  simulation  of  a  prototype  system  or  subsystem 

with  a  degree  of  fuectimal  realism  tiiatit  comparable  to  that  of  a  physical  prototype. 

Virtual  Prototyping:  The  process  of  using  a  vinual  prototype,  in  lieu  of  a  physical 

prototype,  for  test  and  evaluation  of  specific  characteristics  of  a  candidate  design. 

These  definitions  are  intended  to  indude  the  following: 

1.  The  intended  functionality  of  the  prototype  that  is  to  be  created  vinually  is 
clearly  defined  and  realistically  simulated;  e.g.,  vehicle  dynamic  performance, 
vehicle  maintainability  functions,  engine  reliability,  and  vehicle 
consent  manufteturafaUity. 

2.  If  bumau  action  is  involved  in  the  int^ed  functionali^  of  the  prototype,  then  the 
human  functions  involved  must  be  realistically  simulated,  or  the  hunum  must  be 
included  in  the  simulation;  Le.,  realtime  operatcr-in'the'lopp  simulation. 

3.  If  no  human  action  is  involved  in  the  intended  functionality  of  the  prototype,  then 
either  off'line  (non«real*tiine)  computer  simulation  of  the  functions  can  be  carried  out; 
e«g>f  dynamic  performance  of  an  engine,  stresses  in  iu  connecting  rods,  and 
fabriction  of  the  connecting  rods,  or  a  combination  of  computer  and  hardware-in-ihe- 
loop  simulation  can  be  carried  out;  e.g.,  vehicle  dynamic  ptuformance  prediction, 
laboratory  durtbUity  testing  for  difficult  to  model  failure  modes,  and  manufacturing 
process  analysis  or  cri^  components.  ^ 

These  definitions  are  intended  to  exdude  the  following: 

1 .  Piitial  simulation  that  does  not  include  the  full  functionality  intended  for  die  prototype; 
e,g„  geometric  modeling  with  a  CAD  system  that  does  not  simulate  dynamic 
performance,  finite  element  stress  analysis  of  a  component  that  does  not  include 
system  or  subsystem  performance  simulation  that  defines  loads  on  the  component, 
and  manufacturing  proceu  planning  that  does  not  consider  component  performance  or 
design  constraints. 
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2.  ShoW'VidMell  exercises  that  lack  a  protot)'pe  level  of  functional  reality;  e.g..  goggles 
and  gloves  simulation  with  no  underljing  physical  or  mathematical  simulation  at  an 
engineering  or  manufaeturinf  level  of  reality. 

To  provide  background  on  developments  that  have  eccuired  during  the  put  decade  in 
dynamic  simulation,  a  brief  summary  of  its  evoludon  for  ofMine  (non-real*time)  applications 
is  provided.  A  vision  is  suggested  for  real*time  operator‘in*the-loop  simulation  that  creates 
the  opportunity  for  virtual  prototyping  in  a  broad  range  of  mechanical  system  duign  and 
development  applications,  with  emphasit  on  ground  vehicles  and  construction  equipment 
applications.  Real«time  recursive  dynamics  formulations  thu  are  well'SUited  to  exploit  the 
emerging  capabilities  of  shared  memory  parallel  processors  are  summarized,  with  references 
to  fimher  developments.  Emerging  technologies,  including  recursive  dynamics,  for  advanced 
driving  simulation  and  virtual  prototyping  applications  are  summarized,  culminating  in  the 
current  lo^Iementation  of  a  number  of  advanced  ground  vehicle  driving  simulators  that  will 
support  a  broad  range  of  human  factors  research,  including  highway  safety  and  vehicle  and 
highway  system  design.  Finally,  other  operatoMn*the*loop  applications,  primarily 
telerobotici  and  construction  equipment  are  outlined,  to  provide  an  indication  of  the  potential 
that  exists  for  virtual  prototyping  in  a  brnad  range  of  Concurrent  Engineering  i^lications. 


2,  Off'Line  Dynamic  Simulation 

To  illustrate  the  capabilities  that  have  evolved  in  off>line,  or  non>real>time  dynamic 
simulation,  consider  the  tractor-trailer  roll  subility  analysis  suggested  by  the  scenario  shown 
in  Figure  1 .  A  tractor-trailer  vehicle  drives  along  a  road  surface  and  encouiiiers  a  depression 
that  is  at  an  angle  with  the  roadway,  causing  roll  motion  of  the  vehicle  as  it  transiu  the 
irregular  road  surface.  The  objective  is  to  create  a  dynantic  simulation  of  the  tractor-trailer  and  1 

its  contact  with  the  road  surface  via  its  tires,  to  predict  roll  motion  of  the  vehicle  at  it  moves  j 

through  the  depression.  I- 

To  model  the  tractor-trailer  using  a  commercial  dynamic  simulation  program  such  as  i  i 

DADS  [IS],  the  vehicle  kinematics  and  internal  force  characteristics  are  modeled  using  a  |  ^ 

library  of  joints  and  force  elements  that  are  offered  within  the  dynamic  simulation  computer  I  j 

program.  Shown  in  Figure  2  is  a  sampling  of  standard  kinematic  connections  between  pairs  |  | 

of  bodies  [9]  «htt  can  be  used  to  make  up  the  model  of  a  mechanical  system,  such  as  the  |  |. 

tractor-trailer  "  tele  in  question.  Also  shown  is  an  iUustradon  of  a  force  element  [9]  that  can  |  | 


be  used  to  acecu.-t  for  forces  acting  internal  to  the  mechanical  system  due  to  springs,  I  | 

dampers,  hydraulic  actuators,  electrical  motors,  and  a  variety  of  related  force  |  ,|  f  , 
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Figure  1.  TVict(«^‘rniler  with  Depression  in  Road 

To  illuftrate  the  use  of  Mnematic  and  force  building  blocks  illustrated  in  Figure  2,  a 
tiacwr-irailer  model  suittble  for  roll  stability  analysis  in  the  situation  shown  in  Hgure  1  is 
described  in  Figure  3.  Rotational  and  translational  joinu  are  used  to  permit  roll  and  heave 
(vertical  relative  to  chassis)  motion  of  each  of  the  five  axles  and  associated  wheel  sets  that 
mfif?.  up  the  model  of  a  tractor-trailer.  Suspension  springs  and  shock  absorben  are  accounted 
for  by  force  elements  between  the  axles  and  the  chassis  of  the  tractor  and  the  trailer,  as 
shown.  The  load  leveling  effect  of  leaf  springs  in  the  tractor  and  trailer  suspension 
subsystems  is  accounted  for  by  modeling  the  leaf  spring  as  bodies  that  are  pivoted  relative  to 
the  c-bssses  of  the  tractor  and  trailer,  as  in  the  real  i^pllcarion,  with  spring  effects  concentrated 
at  the  ends  of  the  bodies.  This  permiu  the  intended  nearly  equal  distribution  of  loads  across 
pairs  of  axles  in  the  tractor  and  trailer.  Vertical  and  lateral  forces  due  to  tire  contact  with  the 
road  surface  ue  calculated  using  empirical  models  of  the  tires  and  are  transfered  to  the 
appropriate  axle.  The  tractor  and  trailer  are  coupled  to  represent  the  effect  of  the  "fifth  wheel" 
connection  between  the  tractor  and  trailer. 


vehicle  simuladon  that  tie  typical  of  those  found  in  automobiles  and  heavy  trucks.  It  has  been 
used  extensively  in  comparison  of  alternative  algorithms  and  benchmarking  on  alternate 
computer  platforms.  It  is  used  in  this  paper  to  provide  a  concrete  example  of  the  class  of 
algorithms  being  considered  and  to  serve* as  the  basis  for  computational  efficiency 
comparisons  between  algorithms  and  alternate  computer  implementations. 


Figures.  KghMobmtyMultipuipose  Wheeled  Vehicle  (HMMWV) 
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The  schematic  represenution  of  a  fourteen  body  model  of  the  HMMWV  is  shown  in 
Figure  6.  Rigid  bodies  that  may  move  in  space  and  relative  to  each  other  are  shown 
schematically  as  circled  numben  representing  bodies  1  through  14.  Body  1  is  the  chassis  of 
the  vehicle  and  body  2  is  the  steering  rack.  The  right  front  suspension  subsystem  is 
comprised  of  the  lower  control  arm  (body  3),  the  wheel  assembly  (body  4),  and  the  upper 
control  aim  (body  5).  Each  of  the  other  three  suspmsion  subsystems  is  similarly  constructed. 

Translational  and  routional  Joints  allow  only  one  relative  degree  of  fteedom,  translation 
and  rotation,  respectively,  between  bodies  they  connect  Spherical  Joints  permit  three  reiadve 
rotation  degrees  of  fieedom  between  bodies  they  connect.  Finally,  tie  rod  distance  constraints 
serve  to  constrain  the  distance  beween  points  on  bodies  they  connect. 

A  graph  theoredc  represenution  of  the  HMMWV  model  is  shown  in  Figure  7.  Numbered 
nodes  (circles)  of  the  graph  resent  bodies  identified  in  Figure  6.  Edges  of  the  graph  that 
connect  bodies  represent  joinu  and  tie  rod  disunce  constreints  between  the  bodies  connected. 
It  may  be  observ^  that  there  are  eight  independent  closed  kinematic  loops  in  this  vehicle 
mechanism;  i.e.,  paths  that  may  be  traversed  beginning-ftom  body  1  and  crossing  successive 


218 


joints  and  bodies  to  return  to  body  1.  An  established  method  for  treating  such  closed 
kinemadc  loops  is  to  define  cut-joints,  denoted  with  arrows  crossing  joints  in  Figure  7,  to 
define  the  spanning  tree  graph  shown  in  Figure  8  [13].  This  spanning  tree  provides  a 
definition  of  kinemadc  and  dynamic  computadonal  sequences  that  are  used  to  create  the 
equadons  of  tnodon  of  the  system.  As  will  be  noted  in  the  development  that  follows,  the  cut- 
joints  idendfied  in  Figure  7  must  be  treated  as  constraints  in  the  formuladon  of  the  equadons 
of  modon,  using  the  Lagrange  muldplier  method  of  dynamics  [9]. 


Figure  9.  ReUiive  Coordinate  Kinematics 


the  orthogonal  orientation  transformation  matrix  for  body  i  and  the  joint  relative 
coordinates  u  [9] 

Aj»  AiCijA|j(qij)Cj'5  (2) 

where  is  the  orthogonal  orientation  transformation  matrix  from  the  body  j  joint  reference 
frame  to  the  body  i  joint  reference  frame,  which  depends  on  the  joint  relative  coordinates  q^j, 
As  a  concrete  illusttation  of  relative  coordinate  kinematic  relationships,  consider  the 
chassis  and  upper  control  ann  of  the  HMMWV  model  shown  in  Figure  6.  As  shown  in 
Figure  10,  for  the  rotational  joint  between  bodies  S  and  1,  dj^  ■  0  and  Eq.  1  specializes  to 

-  ri  +  8,5- §51  (3) 

Noting  that,  in  the  case  of  this  rotational  joint,  the  relative  coordinate  qj ^  is  a'rotation  about 
the  unit  vector  Uj^  along  the  axis  of  relative  rotation,  Eq.  3  may  be  differentiated  to  obtain  a 
relative  velocity  relationship.  From  geometric  considerations,  an  angular  velocity  relationship 
between  bodies  5  and  1  can  similarly  be  written  [16].  The  combined  result  is  the  matrix 
relationship 
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Figure  8.  Spanning  Tree  Corresponding  to  Figure  4 

The  basic  concept  of  relative  coordinate  kinematics  between  bodies  that  are  connected  by  a 
joint  is  illustrated  in  Figure  9.  The  pair  of  bodies  shown,  designated  by  indices  i  and  j,  each 
have  associated  x'*y'-z'  body  reference  frames,  with  origins  at  Oj  and  Oj.  In  addition,  joint 
x"-y"-z"  reference  frames  are  located  on  the  bodies  at  joint  definition  points  Oy  and  Oj^. 
The  vectors  S|j  and  Sj^  locate  the  origins  of  the  joint  reference  frames  in  the  respective  bodies. 
The  otienudons  of  the  joint  reference  frames  relative  to  the  body  reference  frames  are  defined 
by  constant  onbogonal  rotation  transformation  matrices  [9]  Cy  and  Cj^  on  bodies  i 
and  j,  respectively. 

Denoting  the  vector  (column  matrix)  of  joint  relative  coordinates  between  bodies  i  and  j  as 
qy,  which  depend  on  the  type  of  joint  selected,  the  following  vector  relationship  can  be 
wrinen  to  define  the  vector  rj  that  locates  body  j  in  space,  as  a  function  of  rj  and  the  relative 
coordinates  qy 

fj  »  n  +  tij  +  d|j(qij)  -  ij  (1) 

where  the  vector  dy  depends  on  joint  relative  coordinates.  Similarly,  the  orthogonal 
orientation  transformation  matrix  Aj  for  the  body  j  reference  frame  can  be  written  in  terms  of 
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where  Ihe  operator  ~  denotes  vector  product  [9).  Defining  coefficient  matrices  in  this 
reladonship  as  B  j ^  and  Dj  £q.  4  may  be  wrinen  in  the  form 

Ys*  BisYi  +  Di5q,5 

where  Y«[r'^,  oj^]  Is  the  composite  vector  of  Cartesian  velocity  and  angular  velocity, 
relative  to  the  inenial  reference  f^e. 


Denoting  gz  "[gr"^,  gjt^]  as  a  composite  vector  of  virtual  displacement  and  virtual 
rotation,  an  analogous  relationship  to  £q.  S  [16]  is  obtained  as 


SZg  at  +  Dts^is 


(6) 


where  Sqjj  is  a  variation  in  the  joint  relative  coordinate  qjj. 

Differentiating  Eq.  5  with  respect  to  time  yields  the  acceleration  relationship 

Vs  ■  +  Oigqis  + 


where  E,j  is  a  term  that  is  quadratic  in  velocities.  For  details  of  the  derivation  of  these 
equations  and  construction  of  the  associated  matrices,  see  Refs.  16  to  18. 


One  of  the  key  coo^utational  steps  in  dynamic  simulation  is  the  calculation  of  the  position 
and  velocity  of  each  body  in  the  system,  relative  to  the  inertial  reference  frame,  once  all 
relative  coordinates  and  their  time  derivatives  are  known.  This  computation  proceeds 
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systensancally,  using  £qs.  1,  2,  and  4,  along  each  branch  of  the  spanning  tree  shown  in 
Figure  8.  As  shown  schemadcaily  in  Figure  11»  for  each  branch  in  the  spanning  tree, 
contputadons  begin  with  the  chassis  and  proceed  outward  toward  the  extreme  bodies  in  each 
branch,  called  tree  end  bodies.  In  each  branch,  computadons  cross  a  joint  ih'om  body  1  to  the 
next  body  and,  if  there  is  a  subsequent  body  in  the  chain,  canying  out  the  computation  across 
that  joint.  The  graph  shown  in  Figure  11  serves  as  a  guide  for  efficient  use  of  a  parallel 
computer,  illustrating  that  compuudons  may  proceed  in  parallel  along  each  :>{  the  nine 
branches  in  the  spanning  tree.  This  serves  as  a  guide  to  coarse-grain  parallelism  that  can 
effectively  exploit  modem  shared-memory  multiprocessors.  While  not  discussed  in  this 
paper,  independent  joint  relative  coordinates  are  defined,  and  dependent  relative  coordinates 
computed  using  algebraic  constraints  associated  with  the  cut  joints  defined  in  Figure  7.  For 
details  of  this  iterative  computation,  see  Refs.  16  and  18. 
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Denoting  the  cut  joint  algebraic  constraints  as 

®(qij)  *  0 
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the  variationai  fonn  of  the  equations  of  motion  of  the  entire  system,  and  of  the  right  ^ont 
suspension  subsystem  of  the  KMMWV,  can  be  written  as 

SZjCMjVs  -  Q3  +  +  8ZT(M,V,  -  Q,) 

+  5ZJ(M5Y8  -  Qj)  +  5Zl(M4'i'4  ~  Q4  +  -  0 

which  must  hold  for  all  kinemadcally  admissible  virtual  displacements  and  rotations  SZj, 
Using  equations  analogous  to  Eqs.  6  and  7  that  relate  the  virtual  displacement  and  acceleration 
of  body  4  to  those  of  body  S  into  Eq.  9  yields 

SZj(Mat3  -  Q,  +  05, X)  5ZT(M,y,  -  Q,) 

+  8Z5{(M8  +  K8)V8  +  RsQ64  “  (Qj  +  L5)  +  PjX}  , 

+  Sq54(Q«^5  +  ^5^54  +  V5  +  W|X)  «  0  /.A, 


where  coefficient  matrices  are  products  of  those  appearing  in  Eqs.  6, 7,  and  9.  Note  that 
Eq.  10  holds  for  all  kinemadcaUy  admissible  virtual  displacements  of  bodies  3  and  5  and 
arbitrary  values  of  8q^.  Thus,  the  coefficient  of  must  be  0,  yielding 

q84»-H8^(Q8y5  +  V5  +  WIX) 


This  observadon  [16,17]  permits  reducdon  of  the  equadons  of  motion  and  soludon  for 
reladve  coordinate  acceleradons  between  bodies  5  and  4,  as  funcdons  of  inboard  body 
accelerations  and  Lagrange  muldpliers. 

The  above  process  is  continued  by  substituting  from  Eqs.  6  and  7  to  eliminate  and 
Y5,  yielding  expressions  that  involve  only  chassis  accelerations  and  Lagrange  muldplien. 
Carrying  out  similar  reductions  along  other  branches  of  the  spanning  tree,  beginning  with  the 
outermost  bodies  and  moving  in  toward  the  chassis,  yields  the  matrix  equation 
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which  involves  only  the  chassis  acceleration  and  Lagrange  multipliers  associated  with  cut- 
joint  constraints.  The  second  line  of  Eq.  12  is  obtained  by  differentiating  the  constraint 
equations  of  Eq.  8  twice.  For  details  of  this  reduction,  see  Refs.  1 6  and  17. 

A  key  characteristic  of  this  recursive  formulation  of  the  equations  of  motion,  based  on  the 
spanning  tree  graph  and  elimination  of  joint  relative  accelerations,  is  that  it  eliminates  all 
relative  coordinate  acceleradons  from  the  reduced  equadons  of  motion  of  Eq.  12,  This 
algorithm  is  thus  called  the  recursive  algorithm  "with  elimination".  T,'.  number  of 
computations  required  for  its  implementation  is  proportional  to  the  number  of  relative 
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coordinates  in  the  longest  chain  in  the  ntechanism.  For  a  single-chain  mechanism  with  n 
joints,  the  number  of  calculations  is  proportional  to  n.  The  algorithm  is  thus  called  "oidcr-n". 

Rather  than  eliminating  the  reladve  coordinate  acceleration  using  Eq.  1 1,  which  involves 
the  inversion  of  a  matrix,  the  last  term  in  Eq.  10  may  be  retained  in  the  equations  of  motion 
and  the  recunive  process  of  eliminating  SZ^  may  be  applied  to  obtain 

+  82l{(M,  +  +  Riq,5  +  B?“5R6q54  -  tQ,  -k  L,]  +  B/gPjU 

-HSq?‘«(Qiyi  +  H,q,8.hVi  +  DT6PlX) 

+  +  QsOisqis  +  ^5^54  +  (G5E15  +  V5)  +  Wj\} »  0 

After  this  process  is  complete,  equations  analogous  to  Eq.  7  are  used  to  write  all  Cartesian 
acccleradoni  in  temos  of  relative  cootdinate  accelerations.  CoefEdems  of  relative  coordinate 
variations  must  then  be  0  [18],  yielding 
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where  the  last  row  is  the  second  time  derivative  of  Eq.  8,  written  in  terms  of  joint  relative 
coordinates.  This  formulation  is  fundamentally  different  from  the  recursive  algorithm  with 
elimination  that  resulted  in  Eq.  12.  First,  it  typically  involves  more  variables,  hence  larger 
matrices,  so  that  the  number  of  calculations  in  solving  Eq.  14  is  proportional  to  the  cube  of 
the  number  of  relative  generalized  coordinates.  This  algorithm  has  come  to  be  called  the 
recursive  algorithm  "without  elimination"  and  is  designated  as  "orde^n3".  For  details  of  this 
algorithm,  see  Refs.  18  and  19. 

For  more  complex  mechanical  systems  that  consist  of  multiple,  closed  kinematic  chains, 
computational  complexity  issues  are  somewhat  more  involved  than  indicated  by  the  order-n 
versus  order*n^  designation  for  single  chain  systems.  For  both  the  formalations  "without 
elimination"  and  "with  elimination,"  all  independent  kinematic  chains  can  be  traversed 
simultaneously,  once  loop  cuts  have  been  applied.  Thus  in  both  cases,  provided  that 
sufficient  parallel  processing  is  used,  the  complexity  of  forming  the  linear  equations  of  motion 
(Eq.  12  and  Eq.  14,  respectively)  can  be  kept  proportional  to  the  length  of  the  longest  such 
chain,  regardlesa  of  the  number  of  chains  in  the  overall  model.  In  the  formulation  "with 
elimination,"  solving  Eq.  12  will  have  complexity  proportional  to  the  cube  of  the  overall 
number  of  Lagrange  multipliers  (cut  constraints),  in  the  model.  In  the  latter  case,  the 
complexity  of  solving  Eq.  14  will  be  proportional  to  the  cube  of  the  overall  number  of 
generalized  coordinates  in  the  system. 
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The  queition  of  which  fonnolerion  will  be  more  effacient  for  a  given  mechanical  system 
model  is  dependent  on  the  chartctciistici  of  the  model;  c.g.,  the  total  number  of  generalized 
coordinates,  number  of  chains,  maximum  length  of  chains,  and  number  of  cut  constraints.  A 
third  variadon  of  the  recursive  dynamics  formuladons  allows  elimination  of  Lagrange 
muldpliers  from  each  kinemadcally  decoupled  loop.  This  may  provide  computational 
advantages  for  systems  that  contain  a  significant  number  of  decoupled  loops.  Full  'Iscussion 
of  this  method  is  beyond  the  scope  of  this  paper,  but  details  can  be  found  in  Refs.  18  and  19. 

Much  as  the  forward  path  sequence  ^Figure  11  idendfied  parallelism  in  kinematic  com¬ 
putations,  the  backward  path  sequence  in  Figure  12  illustrates  that  for  either  the  oider-n  or 
order-n^  algorithms,  formation  of  the  equations  of  motion  proceeds  along  each  branch  of  the 
spanning  tree,  beginning  with  the  outermost  body  and  moving  back  to  the  chassis,  as 
illustrated  in  Figure  12.  Since  each  of  these  computations  is  independent,  this  diagram 
provides  a  guide  to  coarse-grain  parallelism  for  parallel  con^uter  implementation. 


Figure  12.  Backward  Path  Sequence 

4,  Parallel  Processing  Real>Time  Dynamic  Simulation 

Parallel  processing  algorithms  that  exploit  the  coarse-grain  parallelism  outlined  in  the 
preceding  section,  for  both  kinematic  and  kinetic  computations,  have  been  developed  in 


Refs.  20  and  21.  A  number  of  refinements  in  parallel  computational  implementation  have 
been  developed  and  demonstrated  in  Ref.  22,  to  identify  fine-grain  parallel  computation 
oppcmtnities  that  exploit  emerging  shared-memory  multiprocessor  computer  architectures. 
Benchmark  parallel  computer  implementations  of  the  recursive  algorithms,  both  with 
eliminadon  and  without  elimination,  have  been  made  on  an  eight-processor  Alliant  FX/8 
parallel  computer.  In  order  to  achieve  real-time  simulation  of  the  HMMWV  vehicle  illustrated 
in  the  preceeding  secdon,  a  total  computadon  time  per  integndon  dme  step  of  6.7  msec  is 
required  for  explicit  integndon  with  constant  dme  step.  This  figure  is  based  on  an  objective 
of  capturing  15  Hz  behavior  of  the  vehicle  suspension  and  a  rule-of-thumb  estimate  of  ten 
integration  dme  steps  per  Hz. 

The  parallel  task  graph  for  the  recursive  algorithm  without  eliminadon  shown  in 
Figure  13.  which  is  explained  in  detail  in  Refs.  21  and  22,  yielded  a  6.4  msec  per  integndon 
time  step  performance.  This  represents  real-time  simulation  of  a  realistic  ground  vehicle  and 
achieves  75  percent  utilization  of  the  eight-processor  Alliant  FX/8  parallel  computer.  This 
enhanced  level  of  peifomance  is  obtained  by  combiiting  coarse-  and  flne-grain  parallel 
processing  opportunities  identified  by  the  spanning  tire  gnph  and  computational  sequences 
within  the  algorithm. 

As  parallel  computers  with  larger  numben  of  processors  become  available,  additional 
vehicle  simulation  computations  beyond  those  associated  with  the  basic  suspension  and 
chassis  subsystem  can  be  accommodated.  As  illustrated  by  the  vehicle  subsystem  modules  on 
the  periphery  of  the  diagram  of  Figure  14,  numerous  subsystem  models  can  be 
accommodated  on  additional  processors,  computing  force  effects  that  are  incorporated  in  the 
tight  side  ofthe  equations  of  motion,  which  are  generated  by  the  algoiiibrosoutiined  in  the 
preceeding  section.  Thus,  scaling  of  the  vehicle  dynamic  computatipnal  load  is  relatively 
straigbtfotward  on  shared-memory  multi^ocessors  svitb  more  than  eight  compute  elements. 

As  a  final  observation  regarding  computer  architectures  for  real-time  dynamic  simulation, 
computational  experience  with  the  Alliant  FX/8  and  its  vectorized  processors  is  of  some 
Interest  This  computer  peimiu  code  to  be  compiled  with  vectorizadon  suppressed.  In  this 
mode,  the  compute  elements  behave  u  scalar  processors.  Due  to  the  small  dimension  of 
vectors  that  are  used  in  the  dynamics  formulation  and  the  extensive  number  of  compuutions 
with  3x3  matrices,  the  dynamic  simulation  code  runs  essentially  as  fast  on  the  Alliant  FX/8 
with  the  vectoiiadon  option  turned  off.  This  suggeni  ih?T  the  ovediead  usociat^d  with 
starting  up  pipeline  operations  with  the  small  vecton  and  mairiccv  that  are  encountered  in 
dynamics  exceeds  the  benefits  gained.  The  conclusion  that  can  be  drawn  from  this 
computational  experience  is  that  parallel  computers  and  workstations  with  high-^ed  scalar 
RISC  processors,  functioning  with  a  shared-memory,  are  ideally  suited  for  high-speed 
dynamic  computation.  In  contrast,  there  appears  to  be  little  gain  to  be  achieved  with  these 
algorithms  in  the  use  of  pipelined  supercomputers.  The  emergence  of  modest-cost  parallel 
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Figure  14.  Structure  of  Real-Time  Vehicle  Simulation 


superwork$t*tions  and  parallel  cojnputers  tl>ut  auggestt  that  there  is  a  broad  class  of 
applications  that  can  be  effectively  addressed  with  modest-cost  parallel  computeia, 

In  the  past  several  years,  a  number  of  computer  vendors  have  begun  to  offer  multiple 
processor  systems,  utiliiini  RISC  technology,  in  relatively  low-cost  workstation  platforms. 
Larger  systems,  with  up  to  28  processors,  are  available  in  minisupercomputer  configurations. 
These  RISC  processors  are  characterized  by  short,  highly  regular  instruction  pipelines  and  a 
sustained  CPU  throughput  of  one  or  more  scalar  instructions  per  cycle.  As  such,  they  are 
ideally  suited  for  scalar  compuutions  associated  with  the  recursive  dynatxtics  fcnnulations.  In 
four-  to  eight-processor  configurations,  these  systems  offer  sufficient  computational  capacity 
to  support  some  real-time  dynamic  simulation  applications,  at  costs  that  are  an  order  of 
magnitude  less  than  typical  minisupercomputer  class  systems  and  two  orders  of  magnitude 
less  than  ftill-fledged  supercomputers. 

An  implemenution  of  the  HMMWV  simulation,  using  the  recursive  formulation  without 
elimination,  has  been  carried  out  on  a  four  processor  Hewlett  Packard/Apollo  DNIOOOO  RISC 
woficstation.  A  performance  level  of  3.3  milliseconds  per  time  step  was  achieved,  using  all 
four  of  die  DNIOOOO  processors.  The  same  simulation  required  8.5  milliseconds  per  time 
step  on  a  single  DNIOOOO  processor.  The  parallel  processing  speedup  factor  for  the  parallel 
version  was  therefore  137,  representing  a  parallel  processing  efficiency  of  over  64  percent 

The  performance  of  RISC  processors  can  be  expected  to  improve  dramatically  in  the 
future.  Currently,  an  approximate  doubling  of  performance  is  being  observed  every  two 
years.  The  number  of  processors  available  in  multiprocessor  workstations  is  also  increasing, 
with  eight-  to  sixteen-processor  configurations  now  available. 

A  limitation  of  current  generation  multiprocessor  workstations  is  the  lack  of  adequate 
programming  tools  and  run-titae  support  for  development  and  execution  of  parallel 
applications.  In  the  absence  of  such  support,  constructing  parallel  dynamics  Implementations 
currently  requires  considerable  effort  and  specific  familiarity  with  low-level  architectural  detail 
of  the  system.  Similar  problems  exist  with  respect  to  the  lack  of  direct  operating  system 
support  for  deteiministic,  real-time  processing.  However,  as  these  systems  continue  to 
proliferate,  programming  suppon  and  operating  system  functionality  can  be  expected 
to  improve. 

5.  Computer  Graphics 

While  the  scope  of  this  paper  precludes  a  detailed  discussion  of  the  technology  of  computer 
graphics,  it  is  of  interest  to  note  the  significant  advancements  that  have  occurred  in  computer 
image  generation  of  complex  realistic  scenes,  motivated  primarily  by  aircraft  flight  simulators. 
.More  pertinent  to  the  ground  vehicle  applications  discussed  thus  far  in  this  paper,  the  scene 


^hgwn  in  Figure  15  indicatei  the  level  of  textunl  deteil  that  can  be  accommodated  in  scene* 
through  which  i  driver  can  function  [23].  The  revolutionary  developments  that  have  occuircd 
in  high-performance  computer  Image  generation  provide  extraordinarily  realistic  visual 
feedback  to  the  driver  of  the  vehicle,  with  realistic  motion  predicted  using  the  dynamics 
methods  outlined  in  the  previous  two  sections. 


iRfurelS.  Ground  Vehicle  Visual  Imagery 


The  type  of  high-quality,  textured  gnphici  capability  currently  provided  only  by 
specialized,  muld-million  dollar  image  generation  lystema  is  rapidly  evolving  into  lower-cost 
graphics  woricstation  platforms.  High-end  graphics  workstations,  such  u  the  Silicon 
Graphics  IRIS  4D,  offer  features  such  as  texture  mapping  and  can  provide  a  significant  frame 
me  capability.  Such  systems  are  not  currently  capable  of  supporting  the  demands  of  real-time 
image  generadon  for  highly  realistic  operator-ln-ihe-loop  simulation.  However,  as  current 
rates  of  performance  increase,  the  hlghest-end  workstation  systems  can  soon  be  expected  to 
achieve  this  level  of  capability.  By  the  m3d'l990s,  it  can  be  expected  that  multiprocessor 
graphics  workstation  platforms  will  be  available  that  will  be  sufficiently  powerful  to  suppon 
both  real-time  dynamic  simulation  and  reasonably  high-quality  real-time  image  generation. 
This  should  result  in  a  dramatic  reduction  in  the  cost  of  achieving  low  and  mid-range  vehicle 
simulation  capabilities. 
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6.  Motion  Generation 


To  complete  the  realism  of  the  operator's  experience  in  driving  a  vehicle,  it  is  Important  that 
the  placfonn  on  which  the  driver  sits  while  driving  the  vehicle  moves  so  that  the  motion  cues 
experienced  during  driving  are  replicated.  In  the  area  of  aircraft  flight  simulation,  one  of  the 
most  advanced  simulators  oper'/.:d  by  NASA  at  Moffett  Field,  California  is  shown 
schematically  in  Figure  16.  This  major  flight  simulator  has  a  motion  base  that  moves  sixty 
feet  vertically,  fony  feet  laterally,  and  eight  feet  longitudinally,  with  substantial  accelention 
capability.  The  pilot  thus  feels  motion  cues  associated  with  flying  the  aircraft  that  is  being 
simulated,  in  addition  to  seeing  a  visual  display  of  the  motion  that  would  be  experienced  in 
flying  the  actual  aircraft.  WhOe  this  morion  envelope  is  well  suited  to  advanced  aircraft 
simulation,  the  basic  motion  envelope  is  not  suitable  for  ground  vehicle  applications  in  which 
the  vehicle  experiences  sustained  longitudinal  and  lateral  accelerations.  Under  conditions  of 
high  acceleration,  only  modest  vertical  displacement  is  required  for  the  ground  vehicle. 
Nevenheless,  this  motion  generation  technology  has  been  developed  for  aircraft  applications. 


Figure  16.  NASA  Vertical  Motion  Simulator 


At  the  other  extreme  of  motion  generetion,  e^massive'hexapod  motion  base  discussed  in 
Ref.  1  has  recently  been  Instailed  at  the  US  Army  Tank-Automotive  Command  in  Warren, 
Michigan.  This  high-capacity  motion  bue  can  move  a  25  ton  tuiret,  with  up  to  5  g 
acceleradon,  in  precision  motion.  Tliis  and  the  aircraft  simulator  motion  base  shown  in 
Figure  16  clearly  illustrate  that  the  technology  for  motion  generation  in  vehicle  simulation  it 


7.  Ground  Vehicle  Virtual  Prototyping 
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The  most  advanced  ground  vehicle  driving  simulator  in  existence  to  date  is  operated  by  | 

Daimler-Benz  in  Berlin  [24],  This  system,  shown  scbemadciUy  in  Figure  17.  consists  of  a  ' 

thirty-foot-diameter  dome  on  a  platform  that  supports  the  vehicle  cab  in  which  the  driver 

functions.  Graphic  imagety  is  displayed  on  the  interior  of  the  dome,  wrapped  180  degrees 

around  the  driver'i  vehicle.  The  dome  and  platfonn  are  moved  by  a  six-degree-of-fteedom  i 

hexapod  system  that  provides  approximately  two  Hz  motion  response,  With  substantial  roll 

and  pitch.  This  simulator  utilizes  1985  vintage  graphics  that  are  not  textured,  but  provide  a 

sharp  scene  at  high  frame  rate  to  the  driver  of  the  vehicle.  Experience  with  this  simulator  has 

attracted  a  great  deal  of  attention  to  the  potential  that  exists  for  this  new  class  of  advanced 

ground  vehicle  driving  simulators. 


A  new  virtual  proiot^Tping  simulator  that  is  under  construedon  at  The  University  of  Iowa, 
using  advanced  textured  graphics  and  the  recursive  dynamics  algorithms  outlined  in  Sections 
2  and  3,  is  shown  schematically  in  Figure  18.  This  simulator  employs  a  small  hexapod 
motion  base  with  frequency  response  up  to  approximately  ten  Ha  and  represents  the  most 
advanced  vehicle  virtual  prototyping  simulator  in  the  US. 


The  most  advanced  driving  simulator  being  considered  for  construction  at  the  present  time 
is  the  National  Advanced  Driving  Simulator  {25],  shown  schematically  in  Figure  19.  This 
advanced  driving  simulator  is  based  on  the  recursive  parallel  processing  dynamics  methods 
outlined  in  this  paper  and  the  moR  advanced  textured  graphics  capability  that  will  be  available 
in  the  mid-1990s.  The  motion  envelope  of  this  simulator  wdl  be  far  superior  to  that  of  any 
ground  vehicle  driving  simulator  ever  conceived.  It  will  involve  lateral  motion  of 
approximately  thirty-five  feet  and  longitudinal  motion  of  ninety  feet,  with  one  g  of 
acceleration  horizontally  and  2.5  g  vertically.  It  will  support  a  continuous  yaw  ring  on  the 
motion  platform  that  will  pennit  extremely  realistic  motion,  consistent  with  the  scene  through 
which  the  driver  is  progressing,  to  be  generated.  Details  on  the  conceptual  design  of  this 
device  may  be  found  in  Ref.  25. 
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8 .  Telerobotic  and  Construction  Equipment  Virtual  Prototyping 


The  concept  of  a  virtual  prototyping  simulator  for  a  limotely  operated  robot  shown  in 
Figure  20  illustrates  the  concept  of  creating  capability  to  simulate  both  the  performance  and 
visual  environment  of  a  roanipulatOT  or  robot  that  is  controlled  by  a  human  operator  using 
video  feedback.  This  concept  has  been  studied  extensively  with  NASA  for  remote 
teleoperation  of  robots  in  space.  Implementation  of  this  concept  on  an  advanced  graphics 
work  station,  using  a  six  degree*of*freedom  force^feedback  manipulator  controller  shown  in 
Figure  21  (Kraft  mini*mister  with  robot  on  screen)  used  by  the  operator  to  input  desired 
motion  and  receive  force  feedback  indicating  level  of  effort  by  actuator  on  the  robot.  The 
level  of  simulation  detail  incoiporated  in  this  application  includes  dynamic  perfotmance  of 
high'geir  ratio  special  ptupose  drives  in  the  ictuai  robot  in  [26]. 

Motivated  by  the  robot  application,  developments  have  taken  place  in  consmiction 
equipment  eperator-in>the-Ioop  simulation;  e.g.,  a  constnicdon  backhoe.  Actual  construction 
backhoe  operator  consoles  have  been  implemented  with  a  large  screen  visual  display  shown  in 
Figure  22  for  simulation  of  backhoe  operation.  The  real-time  computer  simulation  in  this 
application  includes  the  kinemadcs  and  dynamics  ofthe  backhoe  construction  equipment  as 
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weil  as  dynamics  of  the  hydraulics  system  that  drives  the  backhoe.  This  simulation,  which 
functions  on  a  two  processor  workstation  that  also  drives  the  graphics  projector  can  now  be 
used  to  investigate  alternative  operator  interfaces  and  control  algorithms  [26],  The  breadth  of 
such  applications  for  both  oaining  and  design  for  optimum  performance  of  equipment  in  the 
hands  of  the  operator  is  now  feasible  and  finding  its  way  into  engineering  and 
training  applications. 


\ 


1 


t ; 


The  technology  for  opeTator>in'tb«>loop  virtual  prototyping,  as  regards  graphics  and  motion 
subsystems,  has  been  developed  over  the  put  two  decades  for  aircraft  flight  simulation. 
Dynamic  simulation  of  aircraft  motion  for  pilot>in>the'loop  aircraft  flight  simulation  is, 
however,  much  leu  complex  and  demanding  than  simulation  of  the  ext.emely  nonlinear 
dynamic  effects  of  vehicle  suspensions  and  iire*road  surface  interaction,  and  construction 
equipment  hydraulics.  Major  new  applications  in  ground  vehicle  driving  and 
robot/construction  equipment  virtual  prototyping  are  only  now  feasible,  as  a  result  of  the 
advancements  in  recursive  dynamics  algorithms  and  pirallel  computer  implemenutions 
outlined  in  this  paper.  These  developments,  combined  with  available  computer  graphics  and 
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moUon  base  technologies,  create  a  unique  opportunity  for  tailoring  the  design  of  vehicles, 
robots,  and  construction  equipment  to  the  capabilities  of  the  operator,  investigating  the 
influence  of  human  condidoni  and  capabilities  on  the  operttodi  ability  to  carry  out  complex 
task  of  equipment  operation,  and  for  numerous  other  important  applications  that  influence  the 
lives  of  virtually  every  cidzen  of  the  world  on  a  daily  basis.  These  advances  have  been  made 
possible  by  mathemadcal  and  computtdonal  developments  in  the  theory  of  dynamics  and  its 
parallel  implemenudon  on  emerging  high-speed  RISC-based  parallel  computers.  It  is 
interesting  that  this  midtcmaricil  development  has  been  felt  very  quickly  in  the  field  of  ground 
vehicle  virtual  prototyping. 
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Abstract:  The  M&n/M&chine  Interaction  Dynamics  and  Performance  (MMIDAP)  anal¬ 
ysis  project  seeks  to  create  an  ability  to  study  the  consequences  of  machine  design  alter¬ 
natives  relative  to  the  performance  of  both  the  machine  and  its  operator.  The  MMIDAP 
problem  highlights  the  conflicting  needs  and  views  of  groups  that  focus  on  machine  de¬ 
sign  and  groups  that  focus  on  human  performance,  ergonomics,  and  cumulative  injury 
potential.  This  chapter  will  overview  and  update  ongoing  MMIDAP  capability  develop¬ 
ment  efforts  being  undertaken  by  a  rather  loose  group  of  collaborating  researchers.  An 
attempt  will  also  be  made  to  highlight  problems  associated  with  using  traditional  multi¬ 
body  mechanical  system  analysis  tools  for  musculoskeletal  dynamics  analysis  at  the  level 
of  fidelity  needed  by  the  biomechanics  community.  In  particular  problems  associated 
with  using  traditional  multibody  system  tools  for  viscoelastically  restrained  joints  and 
multiple  muscle  systems  will  be  discussed  and  enhanced  solution  approaches  proposed. 

Keywords:  Human  Performance,  Human  Factors,  Multidisciplinary  Analysis.  Human 
Machine  Interaction.  Biomechanics,  Biodyn;>mic5,  Ergonomics,  Machine  Operator  Sys¬ 
tems. 


1  Introduction 

A  confluence  of  diverse  computer  science,  mechanical  systems,  and  biosystera  technolo¬ 
gies  is  now  fornting.  Advanced  mechanical  system  dynamics  analysis  methodologies, 
biosystem  measurement  and  modeling  techniques,  computer  hardware  configurations. 
Concurrent  Engineering  communications,  database  systems,  anatomical,  biomechanical, 
biodynamical,  behavioral,  and  cognitive  science  research  capabilities  can,  with  reason¬ 
able  effort  and  proper  focus,  be  drawn  together  to  create  a  Man/Machine  Interaction 
Dynamics  and  Performance  (MMIDAP)  analysis  capability.  The  envisioned  capability  is 
to  build  upon  existing  and  readily  extendable  capabilities.  Contained  within  this  chapter 
is  an  abbreviated  review  of  the  MMIDAP  project  and  an  overview  of  work  that  has  been 
initiated  since  the  last  summary  paper  on  the  subject  (1). 


The  final  report  of  the  1985  Integrated  Ergonomic  Modeling  Workshop  [2]  contains 
a  detailed  review  of  pre-1988  software  capability  along  with  a  list  of  recommendations 
for  future  research.  It  specifically  remarks  that  ’’there  is  a  paucity  of  dynamic  interface 
models”  and  that  ”an  integrated  ergonomic  model  is  needed,  feasible,  and  useful,”  The 
report’s  review  shows  that  some  work  exists  under  the  general  heading  of  optimization  of 
sports  motion;  however,  there  is  virtually  nothing  to  support  mechanical  system  designers 
that  must  evaluate  machine  operator  interaction  dynamics  and  performance  with  or 
without  survival  gear,  in  hostile  environments,  on-the-job,  on  earth,  or  in  space. 

The  MMIDAP  project  supports  the  generic  machine  operator  system  design  problem. 
It  is  directed  toward  machines  that  are  controlled  by  a  human  operator's  intelligent 
physical  exertions.  MMIDAP  analysis  tools  will  allow  designers  to  introduce  the  physical 
and  cognitive  limitations  of  a  specific  operator  or  operator  population  class  into  the 
machine  design  process.  The  intent  is  to  develop  the  MMIDAP  analysis  capability  in  as 
generic  a  manner  as  possible.  This  will  enable  its  application  within  a  broad  range  of 
aerospace,  machine  design,  ergonomic,  physical  therapy  and  rehabilitation  engineering 
problems.  There  is  no  desire  to  duplicate  the  statics  and  kinematics  based  software 
systems  that  now  support  human  factors  investigations  such  as  those  identified  in  [2] 
and  (3).  Our  intent  is  to  complement  these  with  new  techniques  that  support  ”what  if?" 
studies  of  problems  that  cannot  ignore  dynamics  and  human  performance  considerations. 

2  Anthropometric  and  Biomechanical  Databases 

The  National  Library  of  Medicine  (NLM)  is  currently  undertaking  a  project  that  intends 
to  build  a  digital  image  library  of  volumetric  data  representing  a  complete  normal  adult 
human  male  and  female  [4].  This  ’’Visible  Human  Project”  will  include  digital  images  de¬ 
rived  from  photographic  images  obtained  from  cryosectioning,  computerized  tomography, 
and  magnetic  resonance  imaging,  for  example  [5].  Several  of  the  MMIDAP  collaborating 
research  groups  have  recognized  the  potential  for  the  analysts  to  define  data  need  to  the 
anatomists  while  they  determine  if  it  is  feasible  with  modern  technology  to  provide  the 
requested  data  as  a  by-product  of  the  ’’Visible  Human  Project. 

Kroemer  (2)  provides  a  review  of  currently  supported  anthropometric  data  bases  and 
computer  models  used  in  the  field  of  ergonomics.  Winters  [6]  provides  a  source  book  for 
multiple  muscle  systems  and  movement  organization  along  with  a  survey  by  Yamaguchi 
[7]  listing  human  musculotendon  actuator  parameters  from  over  20  different  published 
sources.  Additionally  Seireg  in  |8j  provides  the  anthropometric  and  musculoskeletal  data 
used  to  support  musculo  load  shsiring  research  carried  on  at  The  University  of  Wisconsin 
at  Madison. 

One  major  problem  with  existing  biomechanical  data  is  that  it  comes  from  so  many 
different  sources  with  almost  as  many  different  measurement  reference  frames.  A  quick 
scan  of  data  provided  by  Yamaguchi  in  [7)  reveals  considerable  numeric  variation  between 
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reference  sources  for  the  s&me  anatomical  component.  The  data  tables  also  reveal  that 
there  are  considerable  data  gaps.  The  NLM's  Visible  Human  Project  is  presenting  the 
biomechanics  community  vrith  a  unique  opportunity  to  fill  these  gaps  and  to  obtain  a 
consistent  reference  source  of  fundamental  biomechanical  data. 


3  Human  Performance  Database 

There  is  no  lack  of  literature  regarding  the  quantification  of  human  function  or  perfor¬ 
mance.  The  literature  as  a  whole  can  perhaps  best  be  characterized  by  noting  that  it 
lacks  a  common  conceptual  framework  upon  which  human  performance  quantification 
strategies  can  be  based.  As  discussed  by  Kondraske  in  (9]  this  has  made  it  difficult  to 
organize  previous  work  and  compare  methods.  The  approach  that  is  advocated  herein  for 
resolving  this  problem  introduces  the  concept  of  a  functional  unit.  This  entity  is  defined 
in  such  a  manner  that  it  must  possess  a  measurable  resource  level  to  accomplish  a  highly 
focused  t  .^k.  Considering  all  functional  units  collectively  leads  to  the  realization  of  a 
finite  set  of  basic  elements  of  performance  (BEPs).  In  mathematical  terms,  the  BEPs 
define  a  set  of  basis  vectors  while  associated  measured  resource  level  defines  vector  mag¬ 
nitude.  To  specify  a  BEP  one  must  delineate  both  the  functional  unit  and  its  dimensions 
of  performance. 

Human  BEPs  may  be  organized  into  three  primary  domains; 

1.  Central  processing 

2.  Physical:  Environmental  interface 

3.  Physicid:  Life-sustaining 

The  collective  set  of  all  BEPs  forms  a  performance  pool.  This  performance  pool  may 
be  defined  for  an  individual  or  for  a  population  group.  It  defines  levels  of  resources  avail¬ 
able  relative  to  all  dimensions  of  performance  associated  with  all  functional  units.  To 
accomplish  any  task  (physical  or  mental),  humans  draw  upon  appropriate  BEPs  from  the 
performance  pool  in  the  required  amount.  Successful  task  performance  is  determined  by 
the  availability  of  required  BEPs.  If  insufficient  BEP  resources  are  available  from  the  per¬ 
formance  pool,  the  task  cannot  be  accomplished.  If  just  enough  e:dst,  task  performance 
will  be  stressful.  If  more  than  enough  exist,  task  performance  will  be  comfortable.  Un¬ 
fortunately  one  cannot  assume  that  all  BEPs  are  functionally  independent  of  each  other. 
There  are  dependencies  that  must  be  recognized  and  accounted  for  in  the  performance 
analysis  process.  As  stated  by  Fitts  in  (10],  we  cannot  study  man’s  motor  system  at  the 
behavioral  level  in  isolation  from  its  associated  sensory  mechanisms.  We  can  only  analyze 
the  behavior  of  the  entire  receptor-neural-effector  system.  The  implication  here  and  the 
major  challenge  for  MMIOAP  is  to  develop  and  implement  methods  that  automate  the 


ptoceit  of  detecting  and  accounting  for  functional  relationships  between  the  sets  of  BEPs 
that  must  be  simultaneously  exercised  during  task  performance. 

The  development  of  these  functional  relaticnships  in  a  format  compatible  with  being 
interfaced  to  the  human  performance  database  represents  many  cutting  edge  research 
projects  at  the  Human  Performance  Institute  (HPI)  at  The  University  of  Texas  at  Ar¬ 
lington.  Kondraske  in  [9j  and  [11]  provides  a  good  overview  of  task  decomposition  via 
BEP'  and  the  methods  being  used  to  database  the  BEP  records  of  the  3000-!-  patients 
tested  with  systems  developed  at  the  Human  Performance  Institute  fHPI). 


4  System  Performance  Analyses 

} 

t 

A  theory  is  presented  by  Kondraske  in  [12|  that  develops  a  scientifically  based  concep-  >\ 

tual  framework  for  addressing  many  fields  of  concern  relating  to  human  performance.  ' 

The  theory  involves  the  concepts  o*  basic  elements  of  performance  and  human  resource 
economics. 

Many  questions  regarding  biomechanical  behavior  can  and  are  being  addressed  with¬ 
out  consideration  of  system  performance;  however,  human  performance  questions  asso¬ 
ciated  with  complex  tasLs  cannot  ignore  biomechanics  and  biodynamics.  Biomechanical 
models  typically  focus  on  the  principles  of  materials  and  mechanical  behavior,  while  a 
system  performance  model  for  a  given  subsystem  recognises  dependency  on  components 
external  to  the  biomechanical  domain  (vision,  neuromotor  control,  etc.). 

The  basic  difference  between  classic  biomechanical  analysis  and  performance  analysis 
can  be  summarized  as  follows: 

Biomechanical  &  Biodynamicz  Analyeis  •  provide  traditional  static  and  dyntunic 
analyses  that  depend  upon  the  basic  physical  concepts  of  mass,  inertia,  geometry, 
stiffness,  position,  velocity,  acceleration,  musculotendon,  and  environmental  loads. 

Performance  Analysis  •  uset  biomechanical  and  biodynamics  analysis  information  to 
Quantify  the  qualitative  parameters  used  to  characterize  a  system’s  capacity  to 
successfully  accomplish  a  task.  It  focuses  on  providing  analysts  with  an  enabling 
capability  to  ask  and  quantify  answers  to  the  following  3  fundamental  questions:  \ 

1.  Can  the  task  be  accomplished?  If  not,  why  not.  |  ' 

2.  How  well  can  the  task  be  accomplisheti?  I 

s 

3.  What  is  the  best  way  to  accomplish  the  task?  I  | 

1  * 

i  4 

These  questions  may  be  directed  to  either  the  machine  operator,  or  the  machine-  |  J 

operator  system.  |  : 


Performance  analyses  are  simple  in  concept  smd  yet  powerful  as  total  system  design 
and  evaluation  tools.  System  performance  can  be  modeled  in  terms  of  the  available 
performance  resources  of  the  operator  while  quantitative  task  characterization  can  be 
expressed  in  terms  of  the  performance  resource  demands  required  of  the  operator.  A 
detail  development  of  these  concepts  is  found  in  (9j  sind  (12j. 

5  Prediction  of  Human  Motion 

One  fundamental  difference  between  repetitively  testing  human  subjects  and  repetitively 
testing  mathematical  models  is  that  the  human’s  response  is  nonrepeatable,  [131.  The 
modeling  goal  for  the  prediction  of  human  performance  can  therefore  only  be  that  the 
predicted  motion  be  physically  reasonable.  Predictions  and  reasonable  variations  around 
them  should  be  viewed  as  dehuing  an  envelop  of  possible  human  response.  With  this  re¬ 
alization  in  mind,  simplified  motion  prediction  algorithms  can  justifiably  be  introduced 
into  the  motion  prediction  model.  Physical  realizability  can  be  checked  by  viewing  ani¬ 
mated  response,  monitoring  joint  rates,  acceleration,  jerk,  loading,  and  comparing  these 
with  norms  in  the  BEP  database. 

The  program  JACK  [14]  has  several  unique  features  that  make  it  ideal  for  MMIDAP 
application.  Figure  positioning  by  multiple  constraints  [15]  is  a  capability  that  allows 
users  to  specify  trajectc  ~.es  at  several  body  fixed  points  (hand,  feet,  torso)  and  to  then 
have  motion  trajectories  for  ail  other  points  predicted.  Strength  guided  motion  [16]  is 
a  capability  that  allows  for  human  strength  and  comfort  data  to  be  used  in  the  motion 
prediction  process.  The  creators  of  JACK  make  note  of  the  fact  that  others  such  as 
Wilhelms  in  [17]  have  used  forward  dynamics  for  human  motion  prediction.  The  JACK 
development  team  argues  that  utilization  of  a  forward  dynamics  approach  to  human 
animation  is  difficult  for  the  user  to  control  because  users  must  provide  all  joint  torques. 
For  a  3D  system,  this  is  a  near  impossible  tuk.‘  Kinematic  and  inverse  kinematic 
approaches  are  easier  to  manipulate  but  suffer  from  the  potential  of  unrealistic  joint 
motion.  JACK  uses  a  blend  of  kinematic,  dynamic,  and  biomechanical  information  when 
planning  and  executing  a  path.  The  task  only  needs  to  be  described  by  a  starting  point, 
ending  position,  and  external  loads  such  as  gravity  and  weights  to  be  transported.  An 
excellent  review  of  the  program  JACK  and  computer  graphics  research  as  applied  to  the 
animation  of  human  figures  is  provided  by  Badler  in  [14],  [18],  [19]  and  [20]. 

‘Forward  dynamics  solutions  compatible  with  the  high  speed  simulation  needs  of  animation  is  not  yet 
achievable;  however,  forward  dynamics  solutions  can  and  are  being  used  to  study  motion  optimization 
strategies  that  underlie  natural  movement. 


6  Integrated  Musculoskeletal  and  Machine  Dynam¬ 
ics 

The  cteatioi  of  mathematical  models  for  the  characterization  of  system  dynamics  is  a 
fundamental  part  of  engineering  analysis.  Both  mechanical  and  biomechanical  groups 
frequently  make  use  of  lumped  parameter  models.  These  models  consist  of  hinge  con¬ 
nected  rigid  and  flexible  bodies,  i.e.,  multibody  systems.  An  excellent  overview  of  existing 
automated  methods  for  developing  simulation  models  for  complex  mechanical  systems 
via  multibody  dynamics  analysis  software  systems  is  provided  by  Schiehlen  in  [21|.  In 
the  late  1980's,  several  international  groups  discovered  that  equations  of  motion  could 
be  rederived  in  such  a  manner  that  computational  speed  could  be  greatly  enhanced  [22], 
[23],  and  [24].  New  implementations  of  these  and  analogous  methods  with  improved 
speed  and  modeling  capability  are  now  in  use,  [25],  [27],  [28],  and  [29]. 

Multibody  simulation  models  have  been  successfully  used  to  model  certain  classes  of 
musculoskeletal  systems.  However,  modeling  weaknesses  exist  and  these  must  be  recog¬ 
nized  before  one  attempts  to  use  multibody  tools  for  general  biomechanical  and  biody- 
namical  application.  The  following  deficiencies  associated  with  vertebrate  biodynamics 
application  have  been  recognized  and  plans  are  now  underway  to  enhance  the  program 
NDISCOS,  [25]  and  [26]  accordingly: 

•  Inverse  dynamics  for  deterministic  systems.  This  capability  is  necessary  to  predict 
resultsmt  joint  loads  associated  with  the  dynamic  interaction  between  machine  and 
operator. 


Intermittent  loop  closure  and  range  of  motion  constraints.  This  capability  is  needed 
to  model  the  interface  between  man  and  machine  and  to  routinely  include  range  of 
motion  limits  for  anatomical  joints. 

Biomechanical  joints  must  now  be  approximated  by  conventional  mechanical  joints. 
To  support  more  detailed  analysis  an  enhanced  joint  modeling  capability  that  in¬ 
cludes  the  full  complement  of  human  joints  defined  by  Nothin  in  [49]  must  be 
developed. 

Rolling/sliding  contact  of  penetrating  surfaces.  This  capability  is  needed  to  model 
the  details  of  joint  motion  and  loading  and  too  adequately  model  the  soft  tissue 
interface  contact  between  an  operator’s  hand  and  the  manipulandum  used  for  ma¬ 
chine  control. 

Flexible  body  modeling.  This  capability  is  currently  available  within  NDISCOS.  It 
is  required  for  stress  distribution  determination  within  the  skeletal  structure  being 
stressed  by  physical  exertion.  This  is  an  important  capability  needed  to  support 
the  joint  prothesis  design  problem. 
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•  Body  clustering.  This  capability  is  needed  to  model  joints  such  as  the  ankle  and 
wrist.  It  is  also  needed  to  model  the  spine.  In  each  case,  relatively  small  bones 
are  tied  together  by  ligaments  into  a  cluster  that  has  limited  range  of  motion. 
The  desire  is  to  develop  a  general  cluster  capability  that  will  be  applicable  for 
generic  mechanical  system  dynamics,  biodynamic,  and  molecular  dynamics  research 
projects. 

The  dynamics  analysis  of  mechanical  systems  is  dominated  by  the  need  to  solve  the 
forward  dynamics  problem.  That  is,  given  a  prescribed  set  of  internal  and  external 
loads,  predict  system  response.  Attempts  to  perform  forward  dynamics  analysis  with 
neuro-musculo-skeletai  systems  are  usually  stopped  by  ones  inability  to  mathematically 
characterize  the  human’s  cognitive  processes  that  generate  the  neural  activation  signals 
that  stimulate  the  body’s  musculo  actuator  system.  Forwards  dynamics  studies  how¬ 
ever  do  provide  the  framework  for  the  study  of  underlying  principles  controlling  how 
individuals  optimize  the  natural  motion  of  their  musculoskeletal  system. 


7  Man/Machine  Dynamic  Interaction 

Figure  1  provides  a  flow  diagram  of  the  proposed  closed  loop  man/machine  interaction 
dynamics  and  performance  assessment  process.  The  output  of  the  program  JACK  is 
animated  human  system  response.  As  for  any  engineering  analysis  study,  the  physical 
realizability  of  predicted  response  must  always  be  checked.  This  is  done  by  viewing 
animated  response  and  resultant  joint  behavior.  Performance  parameters  such  as  joint 
stiffness  and  comfort  level  within  the  JACK  program  allow  users  to  tune  predictions  to 
bring  them  into  the  realm  of  physical  realizability  for  the  particular  population  group 
under  study  (old,  young,  normal,  obese,  handicapped,  etc.)  As  a  further  check,  JACK’s 
predicted  joint  response  information  can  be  used  as  input  to  the  program  NDISCOS. 
This  program  offers  a  functionally  complete  capability  for  smalyzing  models  of  arbitrary 
complexity.  NDISCOS  can  be  used  to  create  a  detail  dynamics  model  for  the  machine 
and  the  machine  operator’s  musculoskeletal  system.  The  associated  equations  of  motion 
for  the  multibody  model  are  exact,  relative  to  the  laws  of  Newtonian  mechanics.  The 
inverse  dynamics  capability  of  NDISCOS  can  be  used  to  obtain  a  refined  prediction 
for  resultant  joint  loading.  Differences  between  JACK  and  NDISCOS  resultant  load 
predictions  stem  from  the  simplifying  assumptions  within  JACK’s  motion  prediction 
algorithms  and  man/machine  interaction  dynamics  effects. 

The  resultant  joint  load  predictions  made  via  NDISCOS’s  inverse  dynamics  capa¬ 
bility  can  be  used  as  input  to  a  capability  that  addresses  the  nondeterministic  muscle 
load  sharing  problem.  If  resultant  joint  loading  and  muscle  load  sharing  predictions  are 
acceptable,  then  motion  and  load  prediction  information  is  ready  to  be  used  as  input 
to  the  human  performance  BEP  database  at  the  HPI.  The  output  of  this  step  provides 
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Commuid  Sign&l  Utilization 


Figure  1:  Cloied-Loop  Man/Maclune  Interaction  Dynamics  and  Performance  Analysis 

Assessment  Process  ; 

f 

another  assessment  of  physical  realizability.  If  results  violate  physical  realizability,  JACK  | 

performance  parameters  can  be  adjusted  and  the  process  repeated.  i 

If  muscle  allocation  studies  are  required,  the  skeletal  system  model  and  associated 
computational  theoretics  will  require  non-trivial  enhancement  to  include  a  detailed  three 
dimensional  characterization  of  critical  joint  complexes.  An  understanding  of  detail  mus-  i 

cle  load  sharing  is  needed  to  explain,  in  a  quantifiable  sense,  exactly  why  certain  design 
options  or  operational  scenarios  have  the  potential  of  causing  machine  induced  discom¬ 
fort,  fatigue,  pain,  or  trauma. 

In  application,  the  usessment  process  will  use  an  iterative  refinement  process  that 
can  be  used  until  the  successive  approximations  strategy  converges  to  acceptable  results. 

The  predictions  either  confirm  that  man/machine  interaction  is  acceptable  or  that  some 
human  performance  parameters  have  exceeded  database  norms.  If  human  performance 
requirements  are  excessive,  machine  design  changes  or  operational  scenarios  can  be  refined 
until  acceptable  performance  measures  are  achieved  for  the  machine  operator’s  population 
group.  It  is  also  possible  to  incrementally  change  population  group  by  selecting  different 
sets  of  anthropometric  and  BEP  data  from  the  database.  Normally  once  an  acceptable 
set  of  JACK  performance  parameters  are  obtained,  they  should  be  rather  insensitive  to 
modest  changes  in  machine  design,  anthropometric,  or  BEP  information. 

The  critical  issue  associated  with  the  determination  of  an  optimal  scenario  is  the  selec-  ■ 

tion  of  a  physically  meaningful  optimization  criteria.  This  problem  is  compounded  with  *  { 

the  need  and  desire  to  minimize  time,  fatigue,  and  machine  complexity  while  maximizing  ^ 

throughput  and  efficiency.  The  next  key  issue  centers  on  how  to  develop  a  systematic  | 

means  for  determining  the  sensitivity  of  performance  relevant  motion  parameters  of  in-  \  j 

terest  to  design  variables.  Design  variables  are  the  system  variables  that  the  engineer  |  I 

alters  during  the  design  optimization  process.  |  I 
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8  Multibody  Methods  for  Biomechanics 

The  inclusion  of  musculoskeletal  loading  effects  for  detail  biomechanical  analysis  of  action 
and  reaction  loading  effects  at  joints  can  become  exceedingly  complex. 

The  modeler  must  address  the  problem  of  modeling  both  joints  and  actuators.  At 
the  coarse  fidelity  level  joints  are  modeled  as  conventional  rotational  type  mechanical 
joints  and  actuators  are  modeled  as  torque  producing  motors.  At  this  level  of  modeling 
fidelity  second  and  higher  order  biomechanical  properties  of  joints  and  muscle  actuation 
are  ignored.  The  capabilities  defined  within  this  section  are  designed  to  enable  the 
biomechanical  modeling  of  the  details  of  musculoskeletal  system  dynamics  and  associated 
joint  loading  effects.  The  objective  is  to  provide  a  generic  capabihty  that  will  allow  the 
biomechanics  modeler  to  hypothesize  theories  to  explain  laboratory  observations  and 
to  computationally  investigate  these  relative  to  the  first  principles  of  kinematics  and 
dynamics. 


? 
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9  Muscle  Modeling  and  Load  Sharing 


Detailed  neuro>musculo-skeletal  modeling  of  the  human  system  or  any  of  its  subsystems 
is  an  extremely  complex  problem  that  is  beyond  today’s  state-of-the-art  capability.  The 
First  World  Biomechanics  Congress  in  August  1990  had  over  80  oral  presentations  on 
the  subjects  of  multiple  muscle  systems,  biomechanics  and  movement  organization.  For¬ 
mal  reports  on  46  of  these  presentations  have  been  collected  by  Winters  in  [6].  From 
these  reports  and  others  presented  at  the  Congress  it  is  clear  that  muscle  dynamics  and 
neuro-musculo-skeletal  organization  and  movement  modeling  is  a  subject  that  will  occupy 
researchers  for  many  more  years. 

There  is  great  deal  known  about  how  nerve  cells  transmit  signals,  how  these  signals 
are  put  together,  and  how  out  of  this  integration  higher  functions  emerge  [30].  Nerve  cells 
are  connected  through  their  synapses  to  form  functional  circuits;  these  are  organized  into 
the  multineuronal  circuits  and  assemblies  that  provide  the  basis  for  neural  organization 
[31|.  Muscles  are  controlled  by  nerves  at  neuromuscular  junctions,  and  at  these  points 
activation  signals  are  biochemically  processed  to  initiate  the  muscle  contraction  process 
132|. 

The  details  of  muscle  modeling  have  several  more  layers  of  complexity.  For  example, 
muscles  are  composed  of  muscle  fibers  that  are  differentiated  by  the  biochemical  prop¬ 
erties  that  dictate  their  respective  res.ponse  speeds  and  resistance  to  fatigue.  When  the 
muscle  is  innerviated,  select  sets  of  muscle  fibers  caUed  motor  units  contract  while  others 
remain  in  a  rest  or  in  an  energetics  recovery  state.  This  motor  unit  apportionment  issue 
further  complicates  the  mathematical  modeling  of  muscle  contraction  dynamics  as  can 
be  seen  from  Hatze’s  complex  mathematical  formulation  of  the  problem  [33]. 

In  spite  of  these  outlined  complexities  in  muscle  dynamics  modehng,  progress  is  being 
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made  at  a  level  compatible  with  real  world  application.  Relatively  simple  mathematical 
approximations  are  appearing  in  the  literature  that  are  providing  a  basis  for  understand¬ 
ing  how  musculotendon  systems  produce  force  as  a  function  of  the  associated  reaction 
dynamics  of  the  biochemical  processes  that  produce  muscle  contraction,  for  example  [34], 
[35],  [36],  [37],  [38],  [39],  [40],  and  [41].  Also  [42]  contains  a  rather  detail  review  of  the 
complexity  associated  with  using  system  identification  techniques  to  obtain  the  data 
needed  to  support  studies  associated  with  joint  dynamics  modeling. 

The  incorporation  of  muscle  dynamics  into  the  framework  of  a  multibody  simulation 
capability  is  a  rather  straight  forward  process  if  the  physics  of  muscle  contraction  can  be 
assumed  known.  This  has  been  demonstrated  by  Hatze  in  [43]  and  Morris  in  [44].  Never 
the  less  forward  dynamics  can  still  be  used  when  known  musculo  innerviation  is  imposed, 
for  example,  by  functional  neuromuscular  stimulation  systems,  as  discussed  by  Chizeck  in 
[45].  It  can  also  be  used  for  well  defined  structured  motion  such  as  reflex  response  actions. 
The  availability  of  measures  for  the  biochemierd  dynamics  of  calcium  ion  concentration 
within  the  system  of  defining  equations  for  muscle  contraction  dynamics  as  defined  in 
[33], [37],  [38],  and  [39],  provides  an  avenue  to  an  understanding  of  the  process  of  fatigue, 
discomfort,  and  pain.  An  extensive  review  of  this  connection  is  available  from  several 
papers  published  in  a  special  issue  on  ’’Occupational  Musde  Pain  and  Injury”  by  the 
European  Journal  of  Applied  Physiology,  [46]  and  [47]. 

Complexities  associated  with  modeling  muscle  contraction  dynamics  are  matched  by 
the  problem  of  resolving  muscle  load  sharing  and  kinematic  redundancy.  The  presence  of 
redundant  muscle  actuators  at  virtually  every  anatomical  joint  implies  that  rules  must 
exist  for  defining  how  muscles  share  the  work  load.  Kinematic  redundancy  within  the 
upper  and  lower  extremety  systems  also  presents  mathematical  modeling  problems.  Re¬ 
dundancy  in  the  physical  system  to  be  modeled  leads  to  a  mathematical  problem  with 
an  infinite  set  of  solutions.  This  problem  is  resolved  by  optimization  techniques  that  find 
the  unique  solution  that  minimizes  a  user  defined  cost  function.  Zajac  in  [48]  provides 
an  indepth  review  of  the  complexity  associated  with  modeling  multijoint  muscle  systems. 
Seireg  in  [8]  provides  an  extensive  summary  of  cost  functions  relevant  to  ongoing  research 
in  muscle  load  sharing  at  The  University  of  Wisconsin  at  Madison. 

9.1  Musculoskeletal  Joints 

In  generd,  biomechanical  joints  can  be  modeled  as  conventional  mechanical  joints  only 
as  a  first  order  approximation.  Nearly  ail  joints  have  complex  concave/ convex  surfaces 
and  compliant  interfacing  tissue  that  acts  to  lubricate,  cushion,  and  limit  the  range  of 
relative  motion  between  the  interfacing  turfaces,  [49]  and  [50] 

The  intent  of  this  section  is  to  outline  modeling  procedures  that  can  be  used  to  go 
beyond  first  order  joint  modeling  restrictions.  The  basic  idea  is  to  forget  about  trying 
to  create  a  variety  of  complex  mechanical  joints  with  an  associated  set  of  kinematically 
constrained  degrees  of  freedom.  Rather,  simply  accept  the  fact  that  musculoskeletal 
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joints  h&ve  six  kinematically  restrained  degrees  of  freedom;  they  normally  do  not  have 
kinematically  constrained  degrees  of  freedom  (dof ).  In  NDISCOS  biomechanical  joints 
are  to  be  modeled  as  restrained  6  dof  joints.  It  is  up  to  the  modeler  to  decide  if  it  is  more 
appropriate  to  kinematically  constrain  or  viscoelastically  restrain  motion  relative  to 
each- of  the  6  degrees  of  freedom  defined  at  each  joint.  This  is  a  decision  that  cannot  be 
made  a  priori,  it  is  a  function  of  the  study  at  hand.  For  example,  assumptions  made  for 
the  study  of  muscle  allocation  and  resultant  joint  loading  effects  during  natural  motion 
optimization  may  not  be  vedid  for  the  study  of  joint  motion  trauma,  such  as  fracture  or 
dislocation. 

The  human  body  has  three  types  of  joints:  synarthrosis  (fibrous),  amphiathrosis 
(cartaginous),  and  diathrosis  (synovial).  From  a  multibody  modeling  point  of  view 
these  have  the  following  characteristics; 

•  Contiguous  bones  joined  together  at  synarthrosis  joints  are  connected  with  fibrous 
tissue.  The  bone  plates  of  the  skull  and  the  teeth  in  the  jaw  are  connected  at 
synarthrosis  joints.  These  allow  virtually  no  relative  movement  and  are  normally 
not  modeled  as  joints  for  kinematic  or  dynamics  analysis. 

The  fibula  and  tibia  of  the  lower  leg  and  the  ulna  and  radius  of  the  lower  arm 
are  connected  along  their  entire  length  by  a  fibrous  interosseus  membrane.  This 
interface  is  classified  as  an  anatomical  joint  but  it  is  not  viewed  as  a  biomechanical 
joint  within  the  context  of  a  multibody  modeling  capability  such  as  NDISCOS.  It  is 
best  to  model  the  coupling  effects  of  such  connective  membrane  as  a  set  of  lumped 
straight  line  passive  viscoelastic  couplers,  each  with  a  well  defined  point  of  insertion 
and  origin,  defined  along  the  length  of  the  membrane  connection. 


t  Contiguous  bones  joined  together  at  amphiarthrosis  joints  are  connected  by  ei¬ 
ther  fibrocartilage  or  hyaline  cartilage.  This  cartilage  joins  one  boney  surface  to 
another.  For  example,  the  2  pubic  bones  in  the  pelvis  and  the  first  rib  and  the 
sternum.  Normally  there  is  very  little  relative  motion  allowed  at  these  joints  and 
relative  motion  effects  here  are  normally  ignored.  If  constraint  loads  at  these  joints 
are  of  interest  then  each  bone  can  be  modeled  as  a  single  body  and  the  connec-  > 

tion  modeled  as  a  joint  with  6  kinematicidly  constrained  degrees  of  freedom.  The  ; 

Lagrange  multipliers  developed  within  NDISCOS  to  enforce  these  kinematic  con¬ 
straints  provide  the  desired  joint  loading  information.  Another  option  is  to  model  '  > 

the  joint  as  a  combination  of  kinematic  constraints  and  non-linear  viscoelastic  re¬ 
straints.  Again,  kinematic  constraint  loads  and  viscoelastic  restraint  loads  are  1  ' 

computed  by  straight  forward  computation.  Cross  axis  viscoelastic  coupling  could  |  | 

also  be  modeled  if  desired  but  this  is  probably  not  needed  and  support  data  would  {  j 

be  difficult  to  obtain.  |  | 

•  Contiguous  bones  joined  together  at  diathrosis  or  synovial  joints  are  the  only  |  | 

joints  that  allow  a  wide  range  of  relative  motion.  At  these  synovial  joints  contigu-  |  , 
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ous  boney  surfaces  are  not  in  direct  physical  contact.  This  means  that  there  are  no 
kinematically  constrained  degrees  of  freedom.  However  for  modeling  purposes  it  is 
frequently  appropriate  to  make  the  justifiable  assumption  that  several  relative  joint 
degrees  of  freedom  are  kinematically  constrained.  Although  the  boney  surfaces  are 
not  in  physical  contact  there  exists  a  variety  of  different  forms  of  tissue  connection 
that  both  cushion  and  limit  range  of  motion.  All  of  these  connectivity  situations 
are  important.  It  is  necessary  to  understand  available  modeling  options  so  that  the 
effects  under  investigation  can  be  accurately  captured  by  the  mathematical  model. 
It  should  be  cle«  that  the  modeler  must  define  the  physics  of  the  problem.  NDIS- 
COS  simply  provides  the  ability  to  study  the  consequences  of  a  hypothesis  relative 
to  the  first  principles  of  viscoelasticity,  kinematics,  statics  and  dynamics. 

9.2  Subclassiiications  of  Synovial  Joints 

Diathrosis  or  synovial  joints  are  ematomically  subclassified  into  three  main  categories 
on  the  basis  of  the  motions  that  are  available.  These  subclassifications  are;  uniaxial, 
biaxial,  and  triaxial.  While  these  subclassifications  are  adequate  for  gross  motion 
discussions  they  need  to  be  further  subclassified  if  the  objective  is  detail  kinematics  and 
dynamics  analysis  via  multibody  methods. 

•  Uniaxial  diathrodial  joints  are  of  two  types; 

-  Hinge  joints  -  These  are  one  degree  of  freedom  joints  that  allow  only  flex¬ 
ion  and  extension  about  a  well  defined  axis.  The  outer  joints  of  all  fingers 
and  toes  are  uniaxial  diathrodial  hinge  joints.  If  included  in  a  simulation  one 
restrained  rotational  degree  of  freedom  and  five  kinematically  constrained  de¬ 
grees  of  freedom  would  normally  be  appropriate.  The  investigation  of  joint 
dislocation,  hand  trauma,  and  peak  regular  and  irregular  grasping  problems 
would  probably  require  some  of  the  5  kinematically  constrained  degrees  of 
freedom  at  some  of  the  joints  to  be  remodeled  as  non-linear  viscoelastically 
restrained  degrees  of  freedom. 

-  Pivot  joints  -  These  are  one  degree  of  freedom  joints  constructed  so  that 
one  component  is  shaped  like  a  ring  and  the  other  shaped  so  that  it  can 
rotate  within  the  ring.  The  Atlas  is  the  first  vertebrae  of  the  cervical  (neck) 
region  of  the  spine.  It  supports  the  skull  and  rests  on  the  Axis,  the  second 
cervical  vertebrae.  The  joint  between  Atlas  and  Axis  is  classified  as  a  pivot 
joint.  While  motion  here  is  primarily  rotation,  motion  about  other  axes  is 
frequently  important  to  model.  In  many  situation  this  joint  should  be  modeled 
as  a  restrained  six  degree  of  freedom  joint. 

•  Biaxial  diathrodisd  joints  are  free  to  move  around  two  axes.  These  are  subclas- 
sified  as; 


250 


-  Condyloid  joints  are  constructed  so  that  a  concave  surface  of  one  bone  slides 
over  the  convex  surface  of  the  interfacing  bone.  Knuckle  joints  of  the  hand 
and  foot  are  examples. 

-  Saddle  joints  are  constructed  so  that  each  interfacing  surface  is  both  concave 
and  convex.  The  knuckle  joint  of  the  thumb  is  an  example 

These  we  normally  modeled  for  first  order  analysis  as  2  restrained  and  4  kinemat¬ 
ically  constrained  degrees  of  freedom.  This  modeling  assumption  forces  the  user 
to  accept  the  limitations  associated  with  modeling  relative  rotational  motion  via 
an  Euler  angle  rotation  sequence.  This  implies  that  the  intersection  of  the  two 
restrained  rotation  axes  is  constant  over  the  full  range  of  joint  motion.  This  mod¬ 
eling  limitation  may  not  be  acceptable  for  some  problems.  In  these  situations  the 
restrained  six  degree  of  freedom  joint  will  be  the  appropriate  modeling  option. 

•  Triaxial  or  Multiaxial  diathrodial  joints  are  joints  that  allow  three  or  more 
degrees  of  relative  freedom.  These  are  subclassified  as: 

-  Ball-and'Socket  joints  are  formed  by  a  ball-like  convex  surface  fitted  within 
a  concave  socket.  The  hip  joint  and  the  glenohumeral  (shoulder)  joint  are  ex¬ 
amples.  The  ball-and-socket  joints  are  normally  modeled  as  three  restrained 
and  three  kinematically  constrained  degrees  of  freedom.  This  modeling  as¬ 
sumption  forces  the  user  to  accept  the  limitations  associated  with  modeling 
relative  motion  via  an  Euler  angle  rotation  sequence  between  the  two  contigu¬ 
ous  body  fixed  reference  frames  defined  at  the  joint.  This  implies  that  the 
intersection  of  the  three  restrained  degrees  of  freedom  axes  is  constant  over 
the  full  range  of  joint  motion.  This  modeling  limitation  may  not  be  acceptable 
for  some  problems.  In  these  situations  the  restrained  six  degree  of  freedom 
joint  will  be  the  appropriate  modeling  option. 

-  Plane  joints  permit  gliding  between  interfar\v3.  surfaces.  The  joints  used  to 
interface  the  eight  Carpus  or  wrist-bones  the  joints  used  to  interface 
the  seven  Tarsus  bones  of  the  foot  are  examples.  The  specification  of  relative 
motion  of  reference  frames  fixed  within  the  bones  of  the  Carpus  and  Tarsus 
is  non-trivial.  The  complexity  of  the  problem  is  evident  from  the  research 
papers  presented  in  (51). 

The  relative  motion  of  bones  interfacing  in  the  Carpus  region  of  the  hand 
and  in  the  Tarsus  region  of  the  foot  are  normally  not  even  attempted.  NDIS- 
COS  provides  the  capability  to  study  this  region  if  supporting  data  can  be 
developed.  The  key  to  the  ability  to  support  this  problem  is  the  capability 
of  NDISCOS  to  accept  a  definition  of  systems  that  include  topological  loops. 
In  topological  tree  problems  the  number  joints  equals  the  number  of  bodies. 


In  topologic&l  loop  problems  the  number  of  joints  exceed  the  number  of  bod¬ 
ies.  The  ability  to  define  both  topological  loops  and  restrained  six  dof  joints 
provide  the  basis  for  this  generic  modeling  capability. 

9.3  Restrained  Six  Degree  of  Freedom  Joints 

Restrained  6  degree  of  freedom  joints  are  designed  to  be  compatible  with  the  needs  of 
biomechanical  joint  modeling.  There  is  a  class  of  problems  that  must  take  into  account 
bone  flexibility,  however,  we  make  the  assumption  herein  that  all  interfacing  bones  at 
restrained  6  dof  joints  are  rigid.  This  assumption  could  be  relaxed  but  at  this  time  it 
does  not  appear  to  be  worth  the  effort. 

In  the  terminology  of  the  program  NrHSCOS  relative  body  motion  at  joints  is  defined 
by  computing  the  relative  motion  of  2  body  fixed  reference  frames.  These  are  referred  to 
as  the  p—  and  q—  frames.  The  user  locates  these  so  that  joint  motion  can  be  computed 
in  a  manner  compatible  with  motion  specification  needs.  They  are  located  and  oriented 
relative  to  their  respective  body  fixed  reference  frames.  Joint  motion  variables  are  de¬ 
veloped  to  define  their  position  and  orientation  relative  to  each  other.  The  restrained 
6  dof  joint  capability  will  allow  the  user  to  specify  a  continuous  surface  fixed  relative 
to  the  p-frame  and  a  set  of  at  least  three  points  fixed  relative  to  the  g -frame.  The 
continuous  surface  relative  to  the  p— frame  lies  on  the  undeformed  surface  of  the  tissue 
that  is  fixed  to  the  bone  at  the  joint  interface.  The  set  of  surface  contact  points  fixed  in 
the  contiguous  body  relative  to  the  q-frame  forms  a  coarse  but  yet  ’’adequate”  represen¬ 
tation  of  the  adjacent  surface.  The  surface  is  assumed  to  be  compliant  and  its  linear  or 
nonlinear  viscoelastic  properties  definable  by  the  user.  The  position  of  each  point  fixed 
in  the  q—  frame  is  computed  relative  to  its  position  along  a  normal  to  the  surface  that 
is  fixed  in  the  p— frame.  If  the  point  is  inside  the  surface  there  is  surface  contact  and 
the  interfacing  tissue  undergoes  compression  with  appropriate  viscoelastic  loads  applied 
equal  and  opposite  at  the  contact  point.  If  the  point  is  outside  of  the  surface,  the  surfaces 
are  not  in  contact  at  the  surface  contact  point  and  the  associated  viscoelastic  loading 
there  is  taken  to  be  zero.  There  is  no  restriction  on  how  many  surface  contact  points 
must  be  in  contact.  The  user  is  responsible  for  making  sure  that  enough  surface  contact 
points  are  defined,  and  the  user  defines  "enough”.  In  some  modeling  situations  it  may 
be  important  to  include  linear  or  non-linear  extensional  viscoelastic  loading,  this  too  can 
easily  be  incorporated. 

The  following  list  outlines  associated  theory.  Let: 

•  (u,v)  -  Surface  coordinates  used  to  locate  a  point  on  the  surface  fixed  relative  to 
the  p— frame. 

•  C(u,v)  -  Vector  from  the  origin  of  the  p— frame  to  the  surface  point  identified  by 
surface  coordinates  (u,v) 
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•  p(f,  -  Vector  from  the  origin  of  the  p— frame  to  the  origin  of  the  9— frame 

•  C,  •  Vector  from  the  origin  of  the  9— frame  to  the  surface  contact  point  a 

•  A,(u,v)  -  Shortest  vector  from  the  p— frame  fixed  surface  to  the  9— frame  fixed 
surface  contact  point  a,  that  is, 

A,(«,t;)  =  Min\pd^  +  C,  -  (7(u,v))  (1) 

for  u,v  £  S  where 

•  S  ■  region  of  the  surface  to  be  searched  for  minimum  contact  distance.  This  is 
introduced  to  allow  physical  insight  to  limit  the  search  region. 

Once  A,(u,u)  is  computed  it  defines  both  the  +  or  -  penetration  distance  and  the 
direction  of  surface  interaction  load  application.  This  penetration  distance  is  used  with 
a  viscoelastic  load  determination  function  to  determine  contact  load.  Normally  a  nega¬ 
tive  value  would  signal  penetration  and  hence  a  compression  of  the  interfacing  tissue.  A 
positive  value  would  signal  no  contact  and  hence  tension  within  connective  tissue.  The 
location  vectors  C,  and  C{u,v)  define  load  application  points  and  the  vector  A,(u,v) 
defines  the  direction  of  application.  The  assumption  here  is  that  sliding  friction  is  effec¬ 
tively  zero.  In  biomechanics  this  is  a  reasonably  good  assumption  since  the  synovial  fluid 
that  lubricates  joints  is  better  than  teflon  on  teflon,  except  in  the  very  aged. 

9.4  Viscoelastic  Restraint  Loads 

The  resultant  nonlinear  viscoelastic  restraint  loads  acting  at  joints  are  the  vector  sum  of 
a  number  of  different  effects.  These  must  be  separated  and  modeled  individually.  From 
the  perspective  of  modeling  two  generic  situation  classes  exist: 

•  Hinge  load  is  a  linear  or  non-linear  function  of  the  relative  displacement  and  rel¬ 
ative  rate  between  p—  and  9—  reference  frames  fixed  in  the  contiguous  bodies  at 
the  hinge  point  associated  with  the  biomechanical  joint.  Relative  displacement  and 
relative  rate  data  are  computed  within  NDISCOS.  This  modeling  option  would 
be  the  appropriate  choice  for  modeling  the  joint  loading  contributions  associated 
viscoelastic  properties  of  menisci  and  discs.  The  program  NDISCOS  is  only  in¬ 
terested  in  obtaining  a  bottom  line  resultant  (6  long)  force/torque  vector.  This  will 
be  applied  in  an  equal  opposite  manner  to  the  contiguous  bodies  at  the  associated 
hinge  point.  The  degree  of  non-linear  equation  complexity  associated  resultant  load 
computation  is  of  no  interest  to  NDISCOS. 

•  Hinge  load  is  a  linear  or  non-linear  function  of  points  of  insertion,  origin,  line  of 
action  and  of  the  relative  displacement  and  relative  rate  of  the  p—  and  9—  reference 


frames  fixed  in  the  contiguous  bodies  at  the  hinge  point.  The  modeling  of  this  type 
of  hinge  load  is  most  appropriately  done  via  the  specification  of  passive  viscoelastic 
couplets. 

The  modeling  of  range  of  motion  limits  take  special  consideration.  These  may  be 
caused  by  a  boney  obstruction  within  the  joint  or  by  connective  tissue  at  its  elastic 
limit  along  some  line  of  action.  The  user  must  decide  if  the  range  of  motion  restraint  is 
best  modeled  as  a  resultant  viscoelastic  restraint  acting  within  the  joint,  or  as  passive 
viscoelastic  couplers  acting  between  points  of  insertion  and  origin. 

9.5  Straight  Lines  of  Action 

Straight  lines  of  action  act  between  the  point  o,  the  point  of  origin  on  one  body  and  the 
point  i,  the  point  of  insertion  on  the  connected  body.  The  vector  between  origin  and 
insertion  defines  both  line  of  action  length  and  direction.  System  equilibrium  conditions 
require  that  the  sum  of  the  load  vectors  applied  at  the  origin  and  the  insertion  points 
equal  zero.  Two  load  vectors  are  developed,  one  at  the  origin  and  one  at  the  insertion. 
They  act  equal  and  opposite  so  that  system  equilibrium  conditions  are  satisfied. 

9.6  Curved  Lines  of  Action 

Musculotendon  tissue  and  other  connective  tissue  between  bones  wrap  over  each  other, 
around  and  over  boney  protrusions.  Loads  are  exerted  not  only  at  the  points  of  origin 
and  insertion  but  along  the  entire  length  in  a  direction  normal  to  the  line  of  action  and  on 
the  structure  at  the  points  where  connective  tissue  contacts  the  surface  that  it  is  wrapped 
around.  Several  layers  of  modeling  complexity  can  be  introduced  to  investigate  this  eifec* 
If  the  descriptive  mathematics  can  be  developed  the  effects  can  be  incorporated. 

•  The  simplest  form  of  a  curved  line  of  action  is  a  straight  line  with  a  single  sharp 
bend  point.  The  bend  point  can  be  fixed  on  either  body  or  on  another  body  in 
the  system.  The  vectors  from  the  origin  and  from  the  insertion  points  to  the  bend 
point  define  the  direction  of  load  application  at  the  points  of  origin  and  insertion. 
The  reaction  load  at  the  bend  point  is  of  such  magnitude  and  direction  that  the 
resultwt  of  the  three  load  vectors  sum  to  zero.  In  a  manner  analogous  to  the 
straight  line  of  action  case  the  triad  of  external  loads  act  on  the  system,  while 
equilibrium  conditions  require  that  their  vector  sum  is  equal  to  zero. 

•  More  complex  curved  lines  of  action  can  be  defined  and  their  loading  effects  upon 
the  bodies  that  they  wrap  around  are  more  difficult  to  define  mathematically.  From 
the  standpoint  of  NDISCOS,  that’s  still  the  user’s  job.  The  only  thing  that  NDIS- 
COS  wants  to  see  is  am  external  vector  load  set  th..t  vectorially  sums  to  zero. 


9.7  Passive  Viscoelastic  Coupling 

This  includes  all  non-contiactile  tissue.  Membrane  connections  resist  extension  but  not 
compression,  cartilage,  discs  and  menisci  resist  compression  and  not  extension.  Depend¬ 
ing  upon  the  situation  they  may  act  along  or  about  any  one  or  all  six  degrees  of  relative 
joint  freedom.  In  many  situations  viscoelastic  loads  acting  relative  to  one  degree  of 
freedom  are  uncoupled  from  all  other  joint  degrees  of  freedom.  An  exception  is  hyaline 
articular  cartilage.  This  tissue  cushions  and  distributes  joint  loads,  it  can  be  considered 
to  be  porous  and  fltud  filled.  It  acts  somewhat  like  a  fluid  filled  sponge.  This  situation 
can  also  be  modelled,  however  it  gets  a  bit  complex.  The  net  result  is  that  the  resultant 
joint  loading  vector  becomes  a  non-lineai  function  of  all  relative  displacement  and  rela¬ 
tive  rate  coordinates.  Again  the  only  thing  that  NOISCOS  wants  to  see  is  the  resultant 
load  vector  of  length  6.  How  it  is  developed  is  the  user’s  problem. 

9.8  Musculotendon  Coupling 

Numerous  theories  exist  for  the  prediction  of  muscle  contractile  dynamics.  It  i<-  a  user 
decision  to  decide  what’s  best.  NDISCOS  provides  the  user  with  the  ability  to  define  a  set 
of  first  order  nonlinear  differential  equations.  These  are  normally  used  in  the  spacecraft 
world  to  define  controller  dynamics.  In  the  biomechanical  world  these  are  used  to  define 
the  dynamics  associated  with  the  biochemical  processes  that  control  muscle  contraction, 
for  example,  via  a  Zahalak,  Zajac,  or  Eatze  model.  NDISCOS  simultaneously  integrates 
these  equations  with  the  equations  of  motion  that  define  mdtibody  system  dynamics. 
The  user  makes  use  of  the  muscle  state  variables  to  define  the  muscle  contraction  loads 
that  are  to  be  applied  to  the  system  along  either  a  straight  or  curved  line  of  action  as 
defined  above.  Again  the  user  must  define  the  physics  of  muscle  contraction,  muscle 
apportionment,  and  motor  unit  recruitment  problems.  NDISCOS  just  wants  to  have  a 
resultant  load  and  a  line  of  action  defined. 

10  Summary 

The  Man/Machine  Interaction  Dynamics  and  Performance  (MMIDAP)  project  seeks  to 
create  an  ability  to  study  the  consequences  of  machine  design  alternatives  relative  to  the 
performance  of  both  the  machine  and  its  operator.  The  envisioned  MMIDAP  capability 
is  to  be  used  for  mechanical  system  design,  human  performance  assessment,  extrapola¬ 
tion  of  man/machine  interaction  test  data,  biomedical  engineering,  and  soft  prototyping 
within  a  Concurrent  Engineering  system.  This  chapter  has  reviewed  the  existing  method¬ 
ologies  and  techniques  needed  to  create  such  capability.  It  hsis  attempted  to  outline  on¬ 
going  efforts  to  integrate  both  human  performance  and  musculoskeletal  databases  with 
the  host  of  analysis  capabilities  necessary  for  the  early  design  analysis  of  dynamic  ac¬ 
tions.  reactions,  and  performance  assessment  of  couphd  machine-operator  systems.  The 


mnltibody  jyitem  dyn&mici  loftware  program  NDISCOS  of  GSFC  wid  Photon  Research 
Atiociatet  can  be  used  for  machine  and  fine  grain  detail  musculoskeletal  dynamics  model¬ 
ing.  The  program  JACK  from  The  University  of  Pennsylvania  can  be  used  for  estimating 
and  animating  whole  body  human  response  to  given  loading  situations  and  motion  con¬ 
straints.  The  basic  elements  of  performance  (BEP)  task  decomposition  methodologies 
associated  with  The  University  of  Texas  at  Arlington’s  Human  Performance  Institute’s 
BEP  database  can  be  used  for  human  performance  assessment.  Techniques  for  resolving 
the  statically  indeterminant  muscular  load  sharing  problems  can  be  used  for  a  detailed 
understanding  of  potential  musculotendon  or  ligamentous  fatigue,  pain,  discomfort,  and 
trauma  problems.  The  MMIDAP  problem  as  defined  herein  highlights  the  conflicting 
needs  and  views  of  groups  that  focus  on  machine  design  and  groups  that  focus  on  mus¬ 
culoskeletal  biodynamics,  on  human  performance  and  cumulative  injury  potential.  An 
attempt  has  been  made  to  show  that  there  is  a  critical  need  to  integrate  design  and 
simulation  tools  and  to  establish  multidisciplinary  lines  of  communication.  Futhermore 
an  outline  is  provided  of  planned  integration  efforts  for  human  performance  analyses,  as¬ 
sociated  databases,  and  mr^hanical  system  design  capabilities.  This  integration  effort  is 
expected  to  provide  am  ability  to  perform  both  stand  alone  studies  and  the  early  sysxem 
trade  studies  needed  to  assess  man/machine  interactic'i  Jvnamics  and  performance. 
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ABSTRACT.  This  paper  summarizes  procedures  for  studying  flexible  multibody 
systems  using  finite  segment  modelling.  In  these  procedures  flexible  members  of 
multibody  systems  are  themselves  modelled  as  multibody  (or  "lumped")  systems.  The 
flexibility  is  then  modelled  by  springs  and  dampers  between  the  bodies.  Although 
the  method  has  the  disadvantage  of  being  computationally  intensive,  the  procedures 
presented  are  intended  to  ease  the  computational  burden  by  efficient  modelling  and 
by  efficient  analytical  formulations.  It  is  believed  that  this  approach  combined  with 
finite  element  and  modal  analysis  methods  can  provide  a  comprehensive  global  and 
local  analysis.  Two  examples  are  presented. 


1.  Introduction 

Of  all  the  feamres  and  phenomena  associated  with  multibody  systems  the  most 
difficult  to  model  are  the  flexibility  effects.  Flexibility  effects  can  si^iificantly  change 
the  dimension  of  the  governing  dynamical  equations  and,  hence,  also  the  form  of 
their  solutions. 

The  modelling  difficulties  stem  from  several  sources:  First,  for  flexible  bodies  it 
is  necessary  to  make  both  physical  and  geometrical  approximations  of  the  elastic, 
plastic,  or  viscoelastic  effects.  These  approximations  in  turn  raise  issues  regarding 
the  consistency  of  the  approximations  and  of  their  effects  upon  the  accuracy  and 
meaningfulness  of  subsequent  analyses.  Next,  the  flexibility  effects  greatly  inaease 
the  number  of  variables  required  in  the  analysis,  and  thus  the  cost  of  the  numerical 
analysis  is  greatly  increased.  Finally,  the  inclusion  of  flexibility  effects  involves  a 
marriage  of  classical  analysis  (that  is,  with  rigid  bodies)  and  structural  dynamics. 
This  means  that  assumptions  used  in  the  classical  analysis  are  violated  •  specifically 
those  related  to  invariant  geometry  of  the  bodies.  •  Thus,  the  implications  of  these 
violations  need  to  be  considered. 


( 

I 


Figure  1.  Two  Bodies  Connected  by  a  Slender  Flexible  Member 

of  Bi,  but  also  upon  the  flexib'lity  of  Bj.  This  flexibility  may  be  modelled  by 
replacing  Bj  by  a  chain  of  finite  segments  connected  by  springs  as  in  Figure  2.  In 
general  these  springs  will  represent  the  torsion,  flexure  and  extension  properties  of 
the  slender  body.  By  such  modelling  a  comprehensive  representation  of  the  behavior 
of  the  slender  member  can  be  obtained  r  including  even  large  deformation  effects. 


Figure  2.  Finite  Segment  Model  of  a  Slender  Body 


The  disadvantage  (or  "cost")  of  such  modelling,  however,  is  a  dramatic  increase  in 
the  number  of  degrees  of  freedom  of  the  ^tem.  If  the  slender  body  is  represented 
by  say  N  segments  then  the  number  of  degrees  of  freedom  may  be  inaeased  by  6N. 
Ihe  numerical  effort  to  solve  the  ensuing  governing  equations  is  then  greatly 
increased. 
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These  difficulties  have  stimulated  a  vast  variety  of  approaches  in  multi-flexible- 
body  analyses.  -The  references  represent  only  a  sampling  of  the  many  writings  on  the 
subject. 

The  methods  of  these  analyses  can  generally  be  divided  into  two  categories  1) 
those  which  focus  upon  the  flexible  bodies  while  using  the  global  multibody  motion 
as  a  source  of  dynamic  loading,  and  2)  those  incorporating  flexibility  effects  into  the 
multibody  dynamics  analysis  -  the  so  called  "lumped  parameter"  or  "Snite  segment" 
approach.  Ihe  method  of  analysis  presented  herein  follows  this  second  approach. 
We  believe  this  approach  has  several  advantages:  First,  it  is  intuitive  and  direct, 
resulting  in  a  relatively  simple  formulation.  Next,  it  is  general  and  applicable  with 
a  broad  class  of  multibody  systems.  Finally,  the  approach  is  "algorithmic"  in  that 
numerical  procedures  are  readily  developed  from  the  governing  dynamical  equations. 
A  disadvantage  of  the  approach  is  that  it  can  be  computationally  expensive.  We 
believe,  however,  that  this  difficulty  can  be  overcome  by  efficiencies  in  the 
formulation  of  the  governing  equations  and  by  advances  in  computer  technology. 

In  what  follows  we  Srst  review  multibody  system  modelling  and  analysis 
procedures.  We  then  consider  the  means  of  incorporating  slender  flexible  bodies 
into  the  analysis.  Finally,  we  present  results  of  analyses  of  two  simple  systems. 


2.  Modelling 

A  multibody  system  is  simply  a  collection  of  bodies  with  a  given  connection 
configuration.  The  bodies  may  be  rigid  or  flexible.  They  may  be  physically 
connected  (as  with  pins  or  spherical  joints),  or  they  may  be  separate  (as  with  spring 
conneaions).  Finally,  the  bodies  may  form  a  closed  loop,  or  they  may  be  open  (as 
in  a  "tree"). 

The  form  and  charaaeristics  of  a  multibody  system  determines  the  complexity  of 
a  dynamical  analysis  of  the  system.  Open  and  physically  conncaed  systems  of  rigid 
bodies  are  the  easiest  to  study.  An  extension  of  such  an  analysis  to  accommodate 
separating  bodies  is  relatively  "straight  forward”.  An  extension  to  accommodate 
closed  loops,  however,  is  somewhat  more  difficult  in  that  constraint  equations  then 
need  to  be  developed.  These  equations  are  usually  algebraic  so  that  when  they  are 
combined  with  the  dynamical  equations  a  coupled  system  of  diSierential  and  algebraic 
equations  is  obtained.  Finally,  extension  to  include  flexibility  effects  are  the  most 
difficult  in  that  assumptions  a^ut  the  flexibility  need  to  be  made.  Such  assumptions 
can  dramatically  affect  the  accurate  of  the  modelling  and  the  subsequent  numerical 
analyses. 

Flexibility  effects  are  generally  important  if  the  multibody  system  is  physically  large 
and  massive,  if  it  contains  slender  bodies,  or  if  its  members  imdergo  high 
acceleration.  Consider  for  example  the  three  body  system  of  Figure  1  consisting  of 
two  rigid  bodies  Bj  and  B3  connected  by  a  slender  flexible  member  83.  Suppose  the 
motion  of  B,  is  specified.  Then  the  motion  of  Bj  depends  not  onlly  upon  the  motion 
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In  the  following  part  of  the  paper  we  present  a  method  of  analysis  which  is 
intended  to  minimize  this  numericd  effort.  The  method  is  based  upon  established 
procedures  of  multibody  dynamics  and  the  procedure  outlined  in  Reference  [30]. 


I 


i 


3.  Analysis 

3.1  BODY  ORIENTATIONS 

Consider  two  typical  adjoining  bodies  of  the  system  as  depicted  in  Figure  3.  Let  the 
bodies  be  called  Bj  and  and  let  Hj,  and  n^  (i  =  1,23)  be  sets  of  mutually 
perpendicular  unit  vectors  fixed  in  Bj  and  B,^.  Then  the  relative  orientation  of  Bj  and 
B,^  may  be  measured  by  the  relative  inclinations  of  the  unit  vectors.  Specifically,  let 
SJK  be  the  orthogonal  matrix  whose  elements  SJKjg,  are  defined  as; 


Figure  3.  Two  Typical  Adjoining  Flexible  Bodies 


SJKj,  =■  Dj-iii.  (1) 


The  unit  vectors  are  then  related  to  each  other  through  the  equation 

(Regarding  notation,  the  J  and  K  in  SJK  and  the  first  subscripts  on  the  unit  vectors 
refer  to  the  bodies  Bj  and  B^.  Repeated  indices  such  as  the  m  in  equadon  (1) 
represent  a  sum  over  the  range  of  the  index.)  - 
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3.2  EULER  PARAMETERS 

The  elements  SJK  may  be  expressed  in  terms  of  relative  orientation  angles  between 
the  bodies  in  a  variety  of  ways  (see  for  example,  Reference  [51]).  From  a 
computational  perspective,  however,  analysts  have  found  it  to  be  more  convenient  to 
express  the  elements  of  SJK  in  terms  of  Euler  parameters  [54,  58].  The  advantage 
of  using  Euler  parameters  is  that  they  are  linearly  related  to  the  components  of  the 
relative  angular  velocity  of  the  bodies.  [Orientation  angles  are  nonlinearly  related 
to  these  components  (through  trigonometric  functions).  In  some  configurations  of 
the  bodies  these  nonlinear  relations  allow  singularities  to  occur  and  these 
computational  difficulties  are  experienced  in  the  numerical  integration  of  the 
governing  differential  equations.]  A  disadvantage  of  using  Euler  parameters  is  that 
four  variables  are  required  to  define  the  relative  orientation  of  the  bodies  whereas 
with  orientation  angles  only  three  variables  are  needed.  Therefore,  with  Euler 
parameters  the  number  governing  differential  equations  to  be  integrated  is  increased. 
However,  this  is  generally  preferable  than  contending  with  singularities  in  the 
equations. 

To  define  the  Euler  parameters,  let  B,c  have  a  general  orientation  relative  to  Bj. 
Then  B^  may  be  brought  into  this  orientation  fi-om  a  reference  orientation  by  a  single 
rotation  about  an  appropriate  axis.  If  is  a  unit  vector  parallel  to  this  axis  and  if6^ 
is  the  rotation  angle,  then  the  relative  Euler  parameters  of  Bi^  are: 

Cy  =  Xy  sin  (0^/2)  i  =  l,23  and  =  cos  (0^/2)  (3) 

where  the  are  the  Uj,  components  of  X^. 

From  a  geometrical  t^ysis  outlined  in  Reference  [58]  the  matrix  SJK  may  be 
expressed  in  te^  of  the  Cy  as: 

(eL  -  ‘*4)  2(«u«k2  -  «k3«k4)  2(£ueu  + 

SJK  =  2(€^j€^  +  ®k2  ~  2(6||2E^3  ~ 

2(€„€u-€y€„)  2(€y€j3  +  CuCfc,)  +  6^4) 

(4) 

The  Cy  are  not  independent:  From  equations  (3)  they  are  seen  to  be  related  by 
the  expression 


where  now  the  measure  the  angular  velocity  of  R|t  relative  to  Rj.  Let  the 
remaining  3N  Yj  be  defined  as 

Y3(N.k-iH  =  i  =  U.3;k=l.....N  (10) 

where  the  are  defined  in  equation  (8). 

The  Yt  are  called  "generalized  speeds"  [52].  They  are  not  always  integrable  into 
elementary  functions.  That  is,  in  general,  there  do  not  exist  individual  orientation 

funcdons  6^  whose  derivatives  are  d>||.  Instead,  the  are  linear  combinations  of 
orientation  angle  derivatives,  or  of  Euler  parameter  derivatives,  as  in  equation  (7). 

3.4  global  kinematics 

The  global  kinematics  of  a  multibody  system  may  be  developed  using  parameters 
outlined  in  Reference  [30].  Specifically,  the  angular  velocity  of  a  typical  body 
in  a  Newtonian  reference  frame  R,  may  be  expressed  in  the  form 

+  ...  +  (11) 

where  the  terms  on  the  right  are  relative  angular  velociuei  through  the  adjoining 
bodies  from  B,  to  B^.  By  using  equations  (9)  and  (11),  may  be  expressed  in  the 
form 

»k  =  (12) 

where  the  (k  =  1,...,N;  t  =  1,...,6N;  m  =  1,23)  form  a  block  anay  of 
coefficients  representing  scalar  components  of  the  "partial  angular  velocity  vectors" 
used  with  Kane’s  equations  [49,  50,  52]  and  where  the  Hon,  (m  =  1,2,3)  are  unit 
veaors  fixed  in  R. 

By  differentiating,  the  angular  acceleration  of  the  bodies  may  be  expressed  as: 

«k  =  («u»Y|  +  WktoY,)n^  (13) 

Explicit  expressions  for  the  and  arrays,  together  with  efficient 
algorithms  for  computing  them,  are  recorded  in  References  [54,  58,  59,  and  60], 
Let  Gk  be  the  macs  center  of  Bk  and  let  Pk  be  a  position  vector  locating  Gk  relative 
to  a  fixed  point  in  R.  Then  Pk  can  be  expressed  in  terms  of  vectors  fixed  in  the 
bodies  of  the  branches  containing  Bk  and  in  terms  of  the  displacements  between  the 
bodies.  The  derivatives  of  Pk  produce  the  velocity  and  acceleration  of  Gk,  These 
derivatives  may  be  evaluated  using  vector  products  and  procedures  recorded  in 
References  [54'  58,  59,  and  60].  The  results  may  be  expressed  in  the  forms 


Finally,  using  the  procedures  of  Reference  [58]  the  e^  are  related  to  the  relative 
angular  velocity  veaor  components  as: 

®ki  “ 

^  =  |(-Sj“kt  ^ 

^  =  ^(€k2“kl  -  «ki“u  ^  «M“k^)  (6) 

6„  =  — (-€uWu  -  -  e^jW^j) 


^kl  “  ~  ®l[3®ia  '*’  *k2*kJ  “  ®U^fc*) 

<!>ia  =*  2(€k3^  -  6uCj3  -  (7) 

^k3  *  2(“€j2€^j  +  ^u^t2  '*’  *k4*Id  “ 

where  the  Ujj  (i  =  1,2,3)  are  the  Uj;  components  of  6^,  the  angular  velocity  of  Bn 
relative  to  Bj. 

3.3  CONFIGURATION  VARIABLES  AND  GENERALIZED  SPEEDS 

Consider  again  the  two  typical  adjoining  flexible  bodies  of  Figure  3.  Let  Qn  and 
be  points  of  the  respective  bodies  which  are  coincident  with  each  other  when  the 
bodies  are  undeformed.  Let  C  be  expressed  in  terms  of  the  unit  vectors  of  Bj  as 
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Let  Rj  and  R^  be  reference  frames  fixed  in  the  undeformed  states  of  Bj  and  B^. 
Then  the  deformations  of  B,  and  B^  may  be  measured  locally  in  Rj  and  R^.  From 
a  global  perspective  the  movement  of  B^  relative  to  Bj  may  be  measured  by  the 
translation  and  rotation  of  R^  relative  to  Rj,  Thus  for  a  system  with  N  bodies  6N 
coordinates  are  needed  to  define  its  configuration  and  motion  (6  for  each  body:  3 
translation  and  3  rotation).  Let  these  coordinates  be  (i  =  1,...,6N),  Next,  let 
(£  =  1,.,.,6N)  be  introduced  as  linear  combinations  of  the  derivatives  of  the  as 
follows:  Let  the  first  3N  be  defined  as 


^3(k-l)*J  ~  “u 


i=  1,2,3;  k=  1 . N 


Vk  =  VktoY.Oo*  (14; 

and 

«k  =  +  Vki-Y,)n„  (15) 

where  the  (k  =  1,...,N;  t  =  1,...,6N;  m  =  1,23)  form  a  block  array  representing 
scalar  components  of  the  "partial  vc'ocity  vectors"  [49,  50,  52],  Explicit  expressions 
for  the  and  arrays,  together  with  algorithms  for  their  computation,  are  also 
recorded  in  References  [54,  58,  59,  and  60], 

3,5  KINEnCS/EQUATIONS  OF  MOTION 

The  equations  of  motion  are  readily  obtained  using  Kane’s  equations.  Using  the 
formulation  of  the  foregoing  kinematic  analysis,  Kane’s  equations  are  ideally  suited 
for  obtaining  equations  of  motion  for  large  lumped  parameter  systems,  Kane’s 
equations  state  that  there  is  a  balance  (or  "zero  sum")  of  the  generalized  applied  and 
inertia  forces.  These  generalized  forces  are  defined  as  a  projection  of  forces  and 
moments  onto  the  partial  velocity  and  partial  angular  '''ciocity  vectors. 

Specifically,  let  the  applied  forces  on  a  typical  'tH>dy  be  equivalent  to  a  force 
passing  through  the  mass  center  together  with  a  couple  with  torque  M Thus  the 
generalized  applied  (or  "active")  force  on  associated  with  the  generalized  speed 
Yj,  becomes 

where  Fkm  and  Miyg  are  the  components  of  and  Mi^  and  where,  as  before, 
there  is  a  sum  over  the  repeated  indices. 

Similarly,  let  the  inertia  forces  on  6,^  be  equivalent  to  a  force  F^  passing  through 

together  with  a  couple  with  torque  M’  Then,  as  in  equation  (16),  the 
generalized  inertia  force  on  B,^  associated  with  the  generalized  speed  Y^,  is 

where  and  are  the  components  of  and  Mj|, 

From  the  principles  of  classical  mechanics  and  may  be  written  in  the 
forms: 


\ 
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=  -m^a^  and  MjJ  =  x  (I^  •  «^)  (no  sum)  (^8)  _ 

where  m).  is  the  mass  of  and  I,^  is  the  central  inertia  dyadic  of 
In  equations  (16)  and  (17)  there  is  no  sum  on  k.  However,  the  generalized  forces 
for  the  entire  system  are  obtained  by  adding  the  contributions  from  the  individual 
bodies.  Hence,  the  generalized  forces  for  the  entire  system  are  obtained  by  summing 
on  k  from  1  to  N  in  equations  (16)  and  (17). 

The  governing  dynamical  equations  may  be  obtained  using  Kane’s  equations  [50, 
52]  which  state  that 


F, +f;=0  f=l,...,6N  (19) 

By  substimting  from  equations  (12)  through  (18)  into  (19)  the  equations  may  be 
written  in  the  form 


(«,p  =  l,....6N)  (20) 

where  the  a(p  and  f^  are 

“  “k  (21) 

and 

f,  =  F,  -  (m^v^^vj^y,  + 

(22) 


Equations  (20),  (6),  (9),  and  (10)  form  a  set  of  13N  first  order  difrerential  equations 
for  the  6N  Yp,  the  3N  and  the  4N  e^.  Since  the  coefficients  a^p  and  fj  of 
equations  (20)  depend  upon  the  four  block  arrays  v^,  v^  and 

since  efficient  algorithms  have  been  written  for  the  computation  of  the.se  arrays, 
algorithms  can  be  written  for  the  numerical  development  and  solutions  of  equation 
(20).  (One  set  of  such  algorithms  forms  the  basis  for  the  program  DYNOCOMBS 
[60].) 

The  flexibility  effects,  which  are  the  focus  of  this  paper,  enter  the  governing 
equations  through  the  of  equations  (22).  We  take  a  closer  look  at  these  terms 
in  the  following  part  of  the  paper. 
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4.  Flexibilitv  Effccts/Slender  Members 


4.1  GENERAL  PROCEDURES 


With  our  finite  segment  modelling  the  fiexibility  effects  are  modelled  by  springs  and 
dampers  between  the  bodies.  With  the  generalized  forces  defined  with  generalized 
speeds  which  are  relative  angular  velocity  components  and  relative  displacement 
derivatives,  the  spring  and  damper  force  and  moment  components  occur  singly  in  the 
governing  equations.  That  is,  with  the  generalized  speeds  defined  as  in  equations  (9) 
and  (10),  the  governing  equations  are  uncoupled  in  the  spring  and  damper  force  and 
moment  components. 

To  demonstrate  this  we  follow  the  procedure  outlined  in  Reference  [30]. 
Specifically,  consider  again  the  two  typi<^  adjoining  flexible  bodies  depicted  in 
Figure  3.  If  (k  measures  the  displacement  of  .'elative  to  Q|„  then  the  velocity  of 
Ok  in  aj'^  inertial  frame  R  may  expressed  as: 


▼o^  *  «j  ^  sum  on  j) 


(23) 


where  is  the  velocity  of  in  R.  If  is  small  or  if  is  that  point  of  Bj  (or  Bj 
extended)  which  coincides  with  O^,  then  equation  (23)  reduces  to 


(24) 


ounilariy,  'hi  juih  dar  velocities  of  the  bodies  are  related  by  the  expression 


(25) 


Let  the  force  system  exerted  by  the  springs  and  dampers  between  the  bodies  be 
equivalent  to  a  single  force  f|.  passing  through  0^  together  with  a  couple  with  torque 
nik.  If  this  is  the  force  system  exerted  on  by  then  by  the  law  of  action-reaction 
[62]  the  force  system  exerted  on  B^  by  Bj  u  equivalent  to  a  single  force  -  passing 
through  Qk  together  with  a  couple  with  torque  -fflk. 

Consider  the  contribution  to  F(  from  these  force  systems;  From  equation  (16), 
this  contribution  F(  may  be  expressed  as  [28, 29, 30] 


*  id\J3Y,)  •  fk  +  (a«./aY,)  •  nik 

+  OVo^aY,)  •  (-fk)  +  (36Jk/aY,)  •  (-ffik) 


(26) 


Consider  the  following  cases: 

Case  1:  is  net  equal  to  either  fy  or  "y.  Then  from  equations  (24)  and  (25), 
the  panial  velocities  and  partial  angular  velocities  of  equation  (26)  are  equal.  That 


'  1 


tell.* 


is, 

dy^JdY,  =  dv^JdY,  and  a«j/aY,  =  daJdY,  (27) 

Hence,  £:om  equation  (26)  in  this  case  F,  is  zero. 

Case  2:  is  equal  to  one  of  the  Then  from  equations  (24)  and  (25),  the 

partial  velocities  aud  partial  angular  velocities  are 

av^yaY,  =  a«./aY,  =  a«,/aY,  =  o  (28) 

and 

dy^JdY,  =  avo^/a^u  =  n-  (29) 

Hence,  from  equation  (26),  the  contribution  to  is 

P,  .  -fj,  (30) 


where  is  the  Oj,  component  of  f^. 

Case  3:  Y^  is  equal  to  one  of  the  Then  from  equation  (24)  and  (25),  the 
partial  velocities  and  partial  angular  velocities  are 

dy^jdY,  =  avo/av,  -  a»/aY,  =  o  (3i) 

doJBY,  *  a«^/a6u  »  ajj  (32) 

Hence,  from  equation  (26),  the  contribution  to  is 

F,  =  -mj,  (33) 

where  m,j  is  the  njj  component  of 

The  contributions  of  equations  (30)  and  (33)  are  to  be  inserted  in  the  generalized 
forces  of  equation  (16).  It  is  seen  that  there  is  a  one-to-one  correspondence  between 
the  joint  force  and  moment  components  and  the  individual  F^.  Thus,  these 
components  occur  singly  in  the  governing  equations. 

4.2  LOCAL  KINEMATICS 

Long  slender  members  manifest  flexibility  effects  more  dramatically  than  nonslender 
bodies.  Therefore,  to  illustrate  the  foregoing  procedures  and  to  provide  an  analysis 
for  the  most  signiiScant  of  the  flexible  bodies  we  will  focus  our  discussion  upon 
slender  members. 
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Figure  4.  Flexible  Beam  and  Model 

Consider  the  flexible  beam  and  its  model  as  depicted  in  Figure  4.  Consider  two 
typical  adjoining  segments  as  in  Figure  S.  Let  Gj  and  Gj^  be  the  mass  centers  of 
segments  and  B^  and  let  Rj  and  be  reference  frames  flxed  in  Bj  and  6,^  with 

origins  at  Gj  and  G^.  Let  6j  and  6^  be  points  at  the  connections  between  the 

springs  and  dampers  of  the  adjoining  bodies  as  shown  (see  also  Reference  [30]).  Letftj 

and  be  reference  frames  with  origins  at  6^  and  6^  which  are  parallel  to  Rj  and 
R^  v.’hen  the  beam  is  undeformed. 

With  this  modelling  and  nomenclature  there  are  12  displacements  and  rotations 
associated  with  each  segment  •  six  at  each  end.  When  the  beam  is  undeformed,  all 
the  reference  frames  are  aligned.  Then  as  the  beam  deforms,  the  reference  frames 

translate  and  rotate  relative  to  each  other.  For  Bj  the  displacement  of  Oj  relative 


Figure  5.  Typical  Adjoining  Beam  Segments  and  Reference  Frames 


to  Gj  may  be  expressed  in  terms  of  three  parameters  and  the  rotation  of  Rj  relative 
to  Bj  (or  R)  may  be  described  in  terms  of  three  parameters.  Similarly,  the 


Variable 

Notation 

Displacement  of  Oj  relative  to  Gj 

“jlk*  “jly»-“jli 

Rotation  of  Rj  relative  to  Rj 

®JIk»  ®Jlyf  ®jli 

Displacement  of  6,^  relative  to  Gj 

’*J2x»  “j2* 

Rotation  of  R,^  relative  to  Rj 

®J2x»  0J2y»  ®J2i 

Displacement  of  R^  (or  Bj^  relative  to  Rj  (or  Bj) 
Rotation  of  R^  (or  B  J  relative  to  Rj  (or  Bj) 

®kx>  ®ky»  ®ki 

Table  1.  Displacement  and  Rotation  Parameters  and  Notation 


displacement  of  6^  relative  to  Gj  and  the  rotation  of  relative  to  Bj  (or  Rj)  may 
be  described  in  terms  of  six  parameters.  Table  1.  presents  a  siunmary  listing  of  the 
parameters  and  notation  (see  References  [30]  and  [58]).  Regarding  the  notation,  the 
first  subscript  of  refers  to  the  segment,  the  second  refers  to  the  segment  end  and 
the  third  refers  to  the  direction.  ITie  over  hat  of  signifies  a  relative 
displacement. 

With  this  notation,  the  displacement  and  rotation  of  relative  to  Bj  may  be 
exT^'essed  in  terms  of  the  end  displacements  and  rotations  by  the  expressions: 

=  «j2x  -  «kii>  V  =  "py  ~  "uy  =  V 

®iB  "  ®J2x  “  ®kU  >  °  ®J2y  "  ®Uy »  ~  ®J2i  ~  ®kU 

Observe  that  although  there  are  12  local  displacement  and  rotation  components 
associated  with  each  segment  (6  at  each  end),  there  are  only  6  relative  displacement 
and  rotation  components. 

4.3  STIFFNESS  COEFnCIENrS 

For  elastic  segments  the  principles  of  structural  analysis  may  be  used  to  determine 
the  relation  between  the  force  and  moment  components  and  the  displacements  and 
rotations.  To  illustrate  this  procedure,  consider  the  tapered  segments  depicted  in 
Figure  6.  Let  the  segments  be  subjeaed  to  tension  forces  as  with  typical  segment  Bj. 

Let  the  extensibility  be  modelled  by  extension  springs  at  each  end  with  moduli  Iq] 
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Figure  6.  Tapered  Flexible  Segments 


Let  the  tapered  segment  be  subjected  to  extensive  force  F  producing  displacements 
Uji  and  Ui2  at  the  ends.  Then  relative  to  a  reference  frame  fixed  at  the  mass  center 
u,,  and  Ui2  are 

Un  =  -Fpjj4n(A,i/Ajj)/[E,(A,i  -  Arf)]  and  Uy  »  Fpj2to(Aa/A^)/[E,(Au  -  A^)] 

(36) 


where  Ej  is  the  elastic  modulus. 

The  geometrical  parameters  Aj,,  A^,  A^,  p,„  and  are  not  independent. 

Specifically,  if  A,i,  A^,  and  the  segment  length  are  known,  then  Ajj,  Pji,  and  p^  are  •  ^ 

Aji  =*  (2/3)  (Aji  A„Aj2  *  Aj2)/(Ajj  +  Ajj)  ^  . 

p„  =  ({,/3)(A,j  +  2A„)/(A„  +  Aj2)  (37)  I  ; 

I  ( 

Pi2  “  (V^^(^'^12  '^U^/(^il  t  ^ 

^3  • 


The  spring  moduli,  the  displacements,  and  the  loading  force  are  related  by  the 
expressions: 
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F  =  -IciiUjj  and  F  =  kjjUjj  (38) 

By  comparing  equations  (36)  and  (38)  we  obtain  the  moduli  as: 

ki'i  =  Ei(A„  -  A^/[p„«n(A,j/A^)l  and  4  =  E,(Aij  -  A^)/[p,jto(A,j/AJ] 

(39) 

If  the  segment  is  straight,  the  analogous  moduli  may  be  obtained  from  equation 
(39)  by  letting 

A„  =  Ajj  =  A,j  =  A.  and  Pj,  =  p,i  =  (40) 


The  results  are 


Iq*,  =  4  =  2E,A,/e, 


Finally,  the  equivalent  spring  modulus  k,j  for  the  spring  segments  in  series  is: 


E,E,(A.,-AJ(A,j-A„) 


L(A,,  -  A.^p„  -  E.(Aj,  -  A,ppijto[^] 


For  straight  segments  k,]  then  becomes: 

k,]  *  2EiEjA,A,/(EjA,fj  +  E^AjJ,)  (-^S) 

Using  similar  procedures  the  spring  moduli  for  segments  in  flexure  and  torsion  may 
be  obtained.  The  Appendix  contains  a  comprehensive  listing  of  the  results. 

5.  Examples 

For  an  example  illustrating  the  efficacy  of  the  method,  consider  a  uniform  flexible 
beam  attached  to  a  rotating  hub  of  radius  r  as  depicted  in  Figure  7.  Let  the  beam 
be  divided  into  20  equal  length  segments  connected  by  flexural  springs  with  stiffness 
developed  following  the  procedures  of  the  foregoing  section. 

Consider  first  the  case  with  the  hub  at  rest  Then  the  efficacy  of  the  modelling  can 
be  checked  by  comparing  the  natural  frequencies  of  the  finite  segment  model  with 
those  computed  from  a  classical  continuum  model.  Table  2  presents  a  comparison 
with  a  measurement  of  the  error  for  the  first  10  modes.  The  units  of  the  namral 


V.  . 
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Consider  next  the  case  of  the  hub  starting  to  rotate  from  rest  to  an  angular  speed 
of  6  radians  according  to  the  expression 

(2/5)  {t  -  (7.5/7t)  sin  (itt/7.5)  rad/sec  0st<15 
0  =  (44) 

6  rad/sec  ISstsSO 

Let  the  hub  radius  r  be  zero;  let  the  beam  length  t  be  10  m;  let  the  elastic  modulus 
E  be  7  X  10“  N/m^;  let  the  second  moment  of  area  of  the  cross  section  I  be 

2  X  10‘’m^;  and  let  the  mass  density  per  unit  length  p  be  1.2  kg/m.  Let  the  beam 
be  modelled  by  10  segments. 


Figure  8  shows  the  results  for  the  tip  displacement.  The  results  are  seen  to  compare 
favorably  with  those  of  Kane,  et  al.  [34]. 


6.  Discussion  and  Conclusions 

These  examples  demonstrate  the  efficacy  of  the  finite  segment  method  for  modelling 
flexible  multibody  systems.  The  examples  show  that  accurate  representations  of 
flexibility  -  a  phenomena  of  continuous,  deformable  bodies  -  can  be  simulated  by 
disCTete,  rigid  systems. 


The  success  of  flexibility  modelling  with  finite  segments  then  forms  the  basis  for 
the  simulation  of  large  flexible  multibody  syster  ’•  panicularly  those  with  significant 
inenia  loading. 

The  finite  segment  modelling  method  is  not  restricted  to  elastic  systems.  Indeed, 
the  method  may  be  used  to  model  viscoelastic,  plastic,  and  even  nonlinearly  elastic 
systems.  The  accuracy  of  the  modelling  increases  as  the  number  of  segments  is 
inaeased. 

There  are  two  principal  disadvantages  of  the  method.  The  first  and  most  obvious 
is  the  computational  burden.  Although  simulation  accuracy  is  improved  with  an 
increasing  number  of  segments,  each  additional  segment  can  increase  the  number  of 
equations  to  be  solved  by  six  second  order  or  thirteen  first  order  differential 
equations.  This  burden  can  be  overcome  somewhat  by  increased  computer  capability 
and  by  greater  availability  of  super  computer  systems.  The  computational  burden 
can  also  be  reduced  by  more  efficient  modelling  and  by  the  development  of  efficient 
algorithms  for  numerical  analysis.  It  is  believed  that  the  procedures  presented  herein 
form  the  basis  for  such  efficient  modelling  and  algorithm  development. 

The  second  disadvantage  cf  the  finite  segment  method  is  that  it  requires  increased 
skill,  insight,  and  intuition  on  the  part  of  the  analyst  These  attributes  are  difficult 
to  transmit  from  one  analyst  to  another.  Improved  software  [67]  and  greater 
experience  of  analysts  are  l^ely  to  diminish  this  disadvantage. 

Finally,  it  is  the  writers’  opinion  that  the  full  capabilities  of  the  method  are  yet  to 
be  developed.  For  example,  the  combination  c-f  the  method  with  the  well  established 
finite  element  method  and  with  the  emerging  method  of  computer  graphic  modelling, 
is  likely  to  lead  to  new  analyses  which  are  more  comprehensive  than  heretofore 
deemed  feasible. 


7.  Appendix:  Stiffness  Coefficients  for  Elastic  Straight  and  Taper  Segments 

The  following  listings  provide  stiffness  coefficients  (moduli)  for  various  combinations 
of  elastic  straight  and  tapered  segments.  The  listed  values  could  be  of  use  in 


software  development  and  in  specific  simulations. 
7.1  STRAIGHT  SEGMENTS 
Extensional  segment 


kt=k?=2E,A,/^.  : 

I;,  length  of  the  segment 

E,:  Young’s  modulus  \ 

A;:  CTOss  seaional  area  > 


*■ 
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Torsional  segment 


J. 


kj 


k:=kj=2GiJi/£, 

G,:  shear  modulus 

Jj:  centroidal  moment  of  inertia 


Bending  segment 


ki- 


k^=k^=2E,V«. 

I,:  moment  of  inertia  of  the 
CTOss  settion 


7.2  COMBINED  STRAIGHT  SEGMENTS 
Extension 


k* 


'Wi 


KV- 


Torsion 


ktj=2EiE^A,/(E,Aj£,  +  E^A,£i) 


kl. 


MBU-W 


Wj5U 


Bending 


k|-2G.Gjyj/(GiJjej+G;iii) 


1^ 


ktj=2EiE,IiV(E.Iji,+EjIi£i) 
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7.3  TAPERED  SEGMENTS 


Extensional  segment 


k?i =Ei(A„-Ari)/[p„ln(A„/A^)] 
ki2=E,(VA„)/[/>i2ln(A^/A„)] 


/Vri  - 1 + + Ao) 
Ai=(«i/3)(A^+2A,,)/(A,,+A^) 

Pi2=(^i/3)(2A^+^,)/(A,,+^2) 


ij:  length  of  the  segment 
E,:  Yoimg’s  modulus  of  the  segment 
cross  sectional  areas  at  right  and 
left  ends  respectively. 

Ajit  CToss  sectional  area  at  mass  center  c. 


Toisional  segment 


kl,=Gi(Ji,-J„)/[Pi,b(Ji,/J^)] 
k{2  =  Gi(JB-Jei)/[P^ln(JJJJ] 

3ci  ~  (2/3)(Ji  1  +  jj jJi2 + 3^2)/ (J|1  +  3,2) 


G,:  shear  modulus  of  the  segment 
JiiJa'-  centroidal  moments  of  inertia 
at  both  ends 

Jtj:  centroidal  moment  of  inertia 
at  mass  center  c, 


Bending  segment 


Ei 


^n=mrh)/[pMW] 

4=Ei(Ii2-I„)/[p^hl(Ii2/IJ] 

I^=(2/3)(I?,+y^+lf, )/(!., +y 

Ij,  Ij:  moments  of  inertia  at  both  ends 
moment  of  inertia  at  mass  center  c 


7.4  COMBINED  TAPERED  SEGMENTS 

Extension 


Torsion  ! 

I 

\ 

I 
» 

! 

Bending 


7.5  COMBINED  STRAIGHT  AND  TAPERED  SEGMENTS 
Extension 


ktj=2E,E^(Aj,-A^)/[liE/VA.j)+2EAPj,ln(Aj,/A^)] 


Torsion 


k|,=2GiGjJi(Jj,-Jcj)/[l.Gj(JjrJc)+2G^iPj,ln(Jj,/J^)] 


Bending 


kt 


k?p2E.E,Ii(Ij,-Ic)/[liE,(Ijj-y+2E,I;Pj,ln(Ij,/I^)] 
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ABSTRACT.  Mullibody  systems  are  quite  often  a  complex  combination  or  assembly  of  mechanical 
elements  with  very  different  mechanical  behavior  rigid  or  flexible,  linear  or  non-linear,  etc.  Sometimes  it 
can  be  very  difficult  to  carry  out  an  efficient  dynamic  simulation  with  a  smgle  software  package. 

In  practical  applications,  some  bodies  are  so  small  and  rigid  that  flexibility  effects  can  be  neglected 
safely,  with  the  benefit  of  an  improved  numerical  efficiency.  In  some  studies,  other  bodies  -such  as  the 
main  hull  of  a  car  or  a  spacecraft-  shall  be  considered  as  flexible  and,  because  of  their  complex  geometry 
and  relatively  high  stiffness,  fmite  elements  and  modal  superposition  techniques  ate  the  most  suitable  way 
to  consider  small  elastic  deformations,  superimposed  to  la^e  rigid  body  rotations  and  displacements. 
Finally,  some  bodies  -as  spatial  booms  or  other  very  slender  appendages-  can  be  very  flexible  and 
experiment  large  (elastic)  deformations  and  -probably-  other  second  order  or  coupling  effects,  that  can  not 
be  captured  with  linear  methods,  such  as  the  standard  mode  superposition;  in  this  case,  large  rotation 
theory  of  beams  and  shell  fmite  elements  is  probably  the  most  suitable  solution. 

This  paper  will  describe  a  simple  and  efficient  methodology  that,  by  the  use  of  a  common  set  of 
variables,  allows  a  unified  study  of  multibody  systems,  where  the  three  types  of  mechanical  behavior 
described  before  coexist  This  formulation  is  independent  of  the  system  topology,  being  able  to  deal  with 
open  and  closed  loops,  and  even  with  variable  or  changing  topologies.  The  position  variables  used  to 
simulate  all  these  mechanical  behavion  (rigid  and  elastic  bodies,  small  and  large  deformations),  are 
Carusian  coordinates  of  points,  Cartesian  components  of  unit  vectors,  joint  coordinates  (optionally)  and 
modal  coefficients  (optionally).  The  use  of  a  common  set  of  Cartesian  and  global  variables  makes  very 
easy  the  task  of  formulating  the  constraint  equations.  The  resulting  formulation  is  then  very  simple,  general 
and  efficient  An  example  of  a  complex  mechanical  system  will  be  presented. 


Introduction 


In  the  last  two  decades  a  great  deal  of  research  has  been  done  in  computer  simuladon  of 
complex  multibody  systems  (MBS),  most  of  them  summarized  in  recent  books  by 
Nikravcsh  (1988),  Roberson  and  Schwertassek  (1988),  Haug  (1989),  Shabana  (1989), 
Huston  (1990),  Amirouche  (1992)  and  Garcia  de  Jal6n  and  Bayo  (1993).  As  a  result  of 
this  research  and  of  the  necessity  of  practical  solutions  in  the  industry,  several  general- 
purpose  computer  programs  have  been  developed  (Schiehlen  (1990)). 

In  the  last  few  years,  a  great  emphasis  has  teen  put  on  the  efficiency  of  the  methods  of 
analysis.  In  kinematic  simulation,  interacdvity  is  a  very  desirable  capability  of  any  pro¬ 
gram,  and  in  the  dynamic  case  large  systems  of  non  linear  differendail  equadons  must  be 
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integrated  as  shortly  as  possible,  even  in  real-time.  Looking  for  this  improved  efficiency, 
some  authors  have  developed  symbolic  methods  for  the  derivation  of  the  motion  differ¬ 
ential  equations.  When  applicable,  the  symbolic  formalisms  have  superior  performance 
than  the  fully  numerical  formulations,  but  until  now  the  latter  remain  the  only  general 
approach  to  the  dynamic  simulation  of  complex  3-D  multibody  systems. 

This  paper  has  as  main  objective  to  summarize  some  developments  carried  out  by  the 
team  in  the  University  of  Navarre  and  CEIT  (San  SebastiSn,  Spain),  in  close  colla^ra- 
tion  with  Prof.  Bayo,  in  the  University  of  California  (Santa  Barbara,  USA) 

1.1.  CHOICE  OF  DEPENDENT  CCXJRDINATES 

In  a  multibody  system  independent  coordinates  only  determine  actually  the  position  of 
the  input  links.  The  position  of  the  remaining  links  can  be  determined  through  the  solu¬ 
tion  of  the  position  problem,  and  the  difficulty  arises  because  this  problem  is  non-linear 
and  there  are  many  possible  solutions.  This  is  the  reason  why  it  is  necessary  to  use  an  ex¬ 
tended  set  of  coordinates,  called  dependent  coordinates,  that  determine  unambiguously 
the  position  and  orientation  of  every  body  in  the  system. 

Dependent  coordinates  are  related  by  a  system  of  nonlinear  algebraic  equations,  the 
constraint  equations,  that  play  a  very  imponant  role  both  in  the  kinematic  and  dynamic 
analysis  of  MBS.  The  kind  of  dependent  coordinates  used  determines  the  number  and 
complexity  of  the  constraint  equations,  and  thus  the  implementation  effort  and  the  com¬ 
puter  time  needed  to  solve  practical  cases. 

It  can  be  found  in  the  bibliography  that  there  are  two  main  kinds  of  dependent  coordi¬ 
nates:  relative  -or  joint-  coordinates  and  reference  point  -or  Cartesian-coordinates. 
With  relative  coordinates  the  position  of  every  body  is  determined  with  respect  to  the 
position  of  the  previous  one  in  the  kinematic  chain,  using  as  many  parameters  as  degrees 
of  freedom  of  relative  motion  that  are  allow<^  by  the  pair  that  joins  them.  The  numter  of 
relative  coordinates  is  minimum  among  dependent  coordinates,  but  they  are  more  com¬ 
plicated  to  implement  With  these  coordinates  the  constraint  equations  arise  from  the 
closure  of  the  independent  kinematic  loops.  In  open  chain  MBS  relative  coordinates  are 
independent  and  so  there  are  not  constraint  equations. 

Reference  point  coordinates  determine  separately  the  position  of  each  body  through 
the  Cartesian  coordinates  of  a  point  and  three  or  four  parameters  (usually  Euler  angles  or 
Euler  Parameters)  to  define  its  angular  orientation.  The  number  of  reference  point  coor¬ 
dinates  is  higher  but  they  are  easier  to  manipulate.  In  this  case  the  constraint  equations 
arise  from  the  kinematic  joints  that  limit  the  relative  motion  of  contiguous  bodies. 

Sometimes,  it  is  interesting  to  use  relative  and  reference  point  coordinates  simultane¬ 
ously.  The  resulting  dependent  coordinates  are  called  mixed  coordinates.  Some  relative 
coordinates,  when  selectively  added  to  a  full  set  of  Cartesian  coordinates,  allows  very 
simple  implementation  of  actuator  forces  and/or  torques,  torsion  springs,  controls,  etc. 

Some  authors,  as  Kim  et  Vanderploeg  (1986a),  use  successively  both  systems  of  de¬ 
pendent  coordinates,  trying  to  gather  the  advantages  of  Canesian  coordinates  (better  and 
simpler  user  interface)  and  relative  coordinates  (easier  control  of  relative  motion  and  im¬ 
proved  effrciency).  This  idea  is  very  useful  to  improve  the  efficiency  taking  into  account 
the  MBS  topology,  as  will  be  seen  later  on  in  this  paper. 

The  MBS  team  at  the  University  of  Navarre  and  CEIT  has  introduced  a  new  class  of 
dependent  coordinates,  fully  Cartesian,  that  they  called  natural  coordinates.  With  these 
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coordinates  the  position  of  a  body  is  determined  by  the  Cartesian  coordinates  of  some 
points  and  the'Cartesian  components  of  some  unit  vectors  rigidly  attached  to  this  body. 
At  least  two  points  and  one  non  co-linear  unit  vector  are  necessary,  in  order  to  define 
completely  the  motion  of  the  body,  and  no  angular  coordinates  are  needed.  With  natural 
coordinates  the  constraint  equations  arise  mainly  from  the  rigid  body  condition  of  the 
links,  and  secondarily  from  some  kinematic  joints. 

The  modeling  of  a  three-dimensional  mechanism  with  natural  coordinates  can  be  car¬ 
ried  out  following  these  general  rules  and  recommendations: 

1.  The  bodies  must  conuin  a  sufficient  number  of  points  and  unit  vectors  so  that  their 
motion  is  completely  defined. 

2.  In  each  link,  at  least  one  point  must  be  located  on  the  axis  of  each  joint  of  the  link  that 
has  a  preferred  direction,  such  as  revolute,  cylindrical,  prismatic  or  helical  joints.  A 
point  shall  be  located  on  those  joints  in  which  there  is  a  point  common  to  the  linked 
elements;  this  point  can  be  shared. 

3.  A  unit  vector  must  be  positioned  at  those  joints  having  a  rotational  or  translational 
axis,  and  should  have  the  direction  of  the  corresponding  axis.  Sometimes,  the  role 
performed  by  a  unit  vector  can  also  be  performed  by  a  couple  of  basic  points. 

4.  Some  joints,  such  as  the  universal  and  gear  joints,  have  their  own  panicular  require¬ 
ments  concerning  the  introduction  of  points  and  unit  vectors. 

5.  Each  unit  vector  is  associated  to  a  specific  basic  point,  and  the  same  single  unit  vector 
can  be  associated  to  several  basic  points.  For  example,  on  the  robot’s  aim  of  figure  2, 
there  are  three  rotational  joints  whose  axes  have  the  same  direction;  it  is  not  necessary 
to  enter  three  different  unit  vectors. 

6.  All  points  of  interest,  whose  positions  are  to  be  considered  as  a  primary  "nknown 
variable  of  the  problem,  can  likewise  be  defined  as  basic  points. 

The  fully  Cartesian  or  natural  coordinates  have  some  interesting  features,  that  are 
convenient  to  summarize  at  this  stage. 

1.  Natural  coordinates  are  composed  of  purely  Cartesian  variables  and  therefore  they  are 
easy  to  define  and  to  represent  geometrically. 

2.  Natural  coordinates  can  be  defined  at  the  joints  and  then  shared  by  contiguous  bodies, 
contributing  to  define  the  position  of  both  bodies  and  significantly  simplifying  the 
definition  of  joint  constraint  equations.  At  the  same  time,  the  total  number  of  vari¬ 
ables  is  kept  moderate. 

3.  With  other  kinds  of  coordinates  it  is  necessary  to  keep  two  sets  of  information:  the 
variables  that  define  the  position  and  orientation  of  the  reference  frame  attached  to 
the  moving  body,  and  the  local  variables  that  define  the  body  geometry  (position  and 
orientation  of  axis,  etc.)  vviih  respect  to  the  moving  frame.  With  natural  coordinates,  a 
single  set  of  variables  define  the  geometry  and  the  position  of  the  body,  directly  in  the 
global  reference  frame.  It  is  only  necessary  :to  keep  some  constant  v^ues  -distances, 
angles,  etc.-  that  are  independent  of  the  reference  frame. 

4.  With  natural  coordinates  the  constraint  equations  that  arise  from  the  rigid  body  and 
joint  conditions  are  quadratic  (or  linear),  so  their  Jacobian  (matrix  of  partial  deriva¬ 
tives)  is  a  linear  (or  constant)  function  of  the  natural  coordinates. 

5.  Natural  coordinates  can  be  complemented  easily  with  relative  angles  and  distances 
defined  at  the  joints,  to  yield  a  mixed  set  of  Canesian  and  relative  coordinates.  Then, 
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to  drive  an  angle  or  a  distance,  and  to  define  forces  and/or  torques  in  joints  become 
rather  straighriorward.  Relative  coordinates  also  simplify  the  task  of  defining  the 
constraint  equations  for  some  particular  joints,  such  as  the  helical  and  gear  joints. 

6.  In  the  constraint  equations  arising  from  natu.’‘al  coordinates,  the  design  variables 
-lengths,  angles,  etc.-  appear  explicitly,  not  hidden  by  coordinate  transformations. 
Thus,  parametric  and  variational  design,  kinematic  synthesis,  sensitivity  analysis  and 
opdmizadon  may  benefit  from  the  use  of  these  coordinates. 


Figure  1 .  RSCR  mechanism.  Figure  2.  Space  robot  with  6  dof. 

Figures  1  and  2  show  an  RSCR  mechanism  and  a  space  robot  modeled  with  natural 
coordinates.  It  can  be  seen  how  points  and  unit  vectors  are  shared  at  the  joints.  For  a  full 
description  of  this  coordinates  and  the  corresponding  constraint  equations  see  Garcia  de 
Jaldn  and  Bayo  (1993). 

1.2.  GENERAL  WAYS  TO  FORMULATE  THE  CXDNSTRAINT  EQUATIONS 

The  fundamental  topics  of  the  formulation  of  the  kinematic  constraint  equations  will  be 
addressed  next.  In  the  case  of  3-D  multibody  systems,  the  constraint  equations  with 
natural  coordinates  originate  in  two  ways: 

1.  from  the  rigid  body  condition  of  the  elements,  and, 

2.  from  some  of  the  kinematic  joints  that  exist  among  them. 

As  an  example,  the  constraint  equations  corresponding  to  the  RSCR  mechanism  in 
figure  1  will  be  formulated  next, 
a)  Rigid  body  conditions  for  body  2; 

{xi  -  xaF  +  (yi  -  yA?  +  {zi  -  zaF  -  diA  =  0 


(1) 


{xi  -  xa)  uax  +  {yi  -  yx)  uav  +  (Zi  -  za)  uaz  7  diA  cos  a  =  0  (2) 

b)  Rigid  body  condidons  for  body  3: 

(xi-X2)^  +  {yi-y2)^  +  |zi-Z2p-d?2  =0  (3) 

(xj  -  X2)  uix  +  (yi  -  y2)  uiy  +  (zi  -  Z2)  uu  -  dt2  cos  p  =  0  (4) 

«ix  +  ‘>iy+“?2-l=0  (5) 

c)  Joint  constraints  for  the  cylindrical  pair  ({rs  -  r2)  x  Ui  =  0;  only  two  independent): 

(y3-y2)uu-(z3-Z2)uiy  =0  (7) 

(Z3  -  Z2)  uu  -  (X3  -  X2)  uu  =  0  (8) 

{x3-X2)uiy-(y3-y2)uu  =0  (9) 

d)  Rigid  body  condidons  for  body  4: 

(X3  -  XB?  +  {ys  -  ysP  +  (Z3  -  Zb)^  -  d3B  =  0  (10) 

{X3  -  Xb)  Uu  +  (ys  -  ys)  Uly  +  (Z3  -  zb)  Uu  -  d3B  cos  7  =  0  (11) 

{X3  -  Xb)  UBx  +  (ys  -  yB)  UBy  +  {Z3  -  Zb)  UBi  -  dsB  COS  (J>  =  0  (12) 

Uu  UBx  +  Uly  UBy  +Uu  UBz  -  COS  (p  =  0  (13) 

It  is  very  easy  to  add  reiadve  coordinates,  with  the  corresponding  constraint  equations. 
For  instance,  to  add  the  distance  (s)  in  the  cylindrical  pair  it  suffices  to  add  the  equation, 

(X3  -  +  (ys  -  ya)^  +  (za  --  Z2)^  -  =  0  (14) 

Notice  that  the  revolute  and  spherical  joints  do  not  introduce  any  constraint  equations. 
It  can  be  realized  that  all  the  equations  (1)-(14)  are  quadratic.  So,  they  will  lead  to  linear 
Jacobians,  very  easy  and  cheap  to  evaluate. 

If  q  is  the  vector  of  dependent  coordinates,  the  equations  (1)-<14)  can  be  represented 
in  the  following  compact  form 

=  0  (15) 

where  time  r  can  appear  in  the  constraint  equations  through  an  externally  driven  coordi¬ 
nate,  for  instance,  ^stance  (s).  A  system  of  nonlinear  equations  similar  to  equations  (1)- 
(14)  can  be  developed  for  the  robot  in  figure  2  or  for  any  other  system. 

At  this  point  it  is  convenient  to  divide  the  methods  to  solve  the  kinematic  and/or 
dynamic  equations  in  two  ^oups:  global  and  topological  methods.  In  the  global  methods 
all  the  equations  are  set  and  then  solved  simultaneously,  with  no  consideration  of  any 
particular  characteristic  of  the  system;  they  rely  on  efficient  sparse  matrix  solvers.  On  the 
other  hand,  the  topological  methods  try  to  take  advantage  of  the  system  topology.  For 
instance,  the  two  ^sterns  in  figures  1  and  2  are  different:  the  RSCR  is  an  closed  loop 
chain  and  the  manipulator  is  an  open  chain.  The  topological  methods  rely  on  the  use  of 
relative  coordinates  and  on  forwaid  and  backward  recursive  formulas. 

2.  Kinematic  Analysis  of  Multi-Rigid-Body  Systems 

In  this  Section  we  will  describe  the  kinematic  analysis  of  rigid  multibody  systems.  We 
will  consider  only  the  Hnite  displacement  problem.  Both  the  global  and  topological 
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methods  will  be  consider,  and  a  short  subsecdon  will  be  dedicated  to  the  concept  of 
space  of  allowable  motions. 

2.1.  GLOBAL  CONSTRAINT  EQUATIONS 

We  Stan  from  a  known  posidon  q  in  which  all  the  constraint  eqs.  (IS)  are  satisfied;  then 
a  finite  increment  is  given  to  the  input  variables  or  degrees  of  freedom.  In  order  to  fmd 
the  new  position,  it  is  necessary  to  solve  the  system  of  nonlinear  constraint  equations. 
This  is  carried  out  by  the  Newton-Raphson  (N-R)  method. 

2.1.1.  Newton-Raphson  and  MotUfied  Newton-Raphson  Iteration.  The  system  of  non¬ 
linear  eqs.  (IS)  can  be  solved  by  the  well  known  Newton-Raphson  iteration  formula 

-  qi) = -  ‘^(qi)  (i6) 

This  system  of  linear  equations  is  sparse  and  can  be  solved  with  an  appropriate  routine 
found  in  a  sparse  linear  algebra  library.  The  standard  N-R  method  requires  a  new  factor¬ 
ization  of  the  Jacobian  for  each  iteration.  The  modified  N-R  iteration  perfotms  several 
forward  and  backward  substitutions  for  each  Jacobian  factorization,  allowing  important 
efficiency  improvements  in  many  cases.  However,  if  the  increments  in  the  input  vari¬ 
ables  are  luge,  the  standard  N-R  shall  be  used  because  it  is  more  robust  and  reliable. 

Sometifnes,  it  is  possible  to  decrease  the  number  of  iterations  of  the  N-R  method  by 
improving  the  position  vector  with  which  the  iteration  is  started.  This  can  be  carried  out 
by  adding  to  the  previous  position  a  correction  based  on  a  velocity  analysis  computed 
with  the  last  Jacobian  available  in  factorized  form.  The  cost  of  this  improvement  is  a 
forward  and  a  backward  substitution. 

2.1.2.  Redundant  Constraints.  Practical  difficulties  in  the  solution  of  eqs.  (IS)  and  (16) 
can  arise  if  there  are  redundant  constraints,  i.e.  additional  but  compatible  constraint  equa¬ 
tions  that  lead  to  a  Jacobian  matrix  with  more  rows  than  columns. 

There  are  two  principal  ways  from  which  redundant  constraint  equations  arise; 

a)  Due  to  convenience  of  implementation.  For  instance,  if  in  the  RSCR  example  in  fig¬ 
ure  1  all  the  eqs.  (1)-<14)  are  kept  a  redundant  equation  arise  because  only  two  of 
eqs.  (TH9)  corresponding  to  the  cross  product  of  vectors  are  independenL 

b)  In  overconstrained  multibody  systems  that  are  exceptions  to  the  Griibler  criterion,  as 
for  instance  in  spherical  mechanisms  and  in  many  very  important  practical  systems. 

Redundant  constraint  equations  can  be  detected  and  eliminated  by  a  preprocessing  of 
the  constraint  eqs.  (IS).  The  main  disadvantage  of  this  method  is  the  need  to  repeat  the 
deoendent  equation  elimination  process  each  time  the  multibody  system  changes  its 
confipratibn,  or  -in  some  cases-  after  large  changes  in  the  position  of  the  system.  Thus 
this  procedure  is  not  suitable  for  real-time  or  interactive  simulations,  because  there  is  no 
time  to  repeat  the  dependent  equations  elimination  process.  The  second  possibility  is  to 
solve  systems  (15)  or  (16)  direaly,  with  a  procedure  capable  of  directly  tackling  redun¬ 
dant  constraints  on  a  strictly  standard  form. 

Let  us  assume  that  system  (IS),  corresponding  to  a  system  with  n  coordinates  and  / 
degrees  of  freedom,  has  m  nonlinear  equations,  of  which  only  (n-f)<m  are  independenL 
As  a  consequence,  one  may  be  tempted  to  think  that  the  redundant  equations  in  (IS)  just 
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produce  an  excess  of  compatible  equations  in  the  linear  system  (16).  If  this  were  true  no 
particular  difficulties  would  appear  during  the  solution,  because  there  are  a  lot  of  ways 
and  numerical  routines  to  solve  linear  systems  of  equations  with  an  excess  of  compatible 
equations.  However,  the  problem  is  a  little  more  complicated,  because  the  redundant  but 
compatible  nonlinear  equations  (IS)  can  induce  an  excess  of  non-compatible  linear 
equations  in  (16)  in  the  intetmediate  iterations.  This  does  not  happen,  for  instance,  in 
velocity  or  acceleration  analysis,  because  in  these  cases  the  Jacobian  matrix  is  evaluated 
in  the  exact  position,  in  which  all  constraint  eqs.  ( 1 S)  are  satisfied. 

Sometimes  this  problem  can  be  solved  using  Gaussian  elimination  with  column  pivot¬ 
ing  and  row  scaling,  because  then,  as  long  as  q;  is  approaching  the  true  solution  at  which 
the  constraint  equations  are  fulfilled,  the  algorithm  tends  to  disregard  automatically  the 
dependent  equations.  Howe’*e^  this  procedure  is  not  sufficiently  robust  and  reliable. 

A  reliable  algorithm  to  solve  the  redundant  system  of  linear  eqs.  (16)  is  the  least- 
square  formulation.  The  normal  equations  corresponding  to  system  ( 1 6)  arc, 

[«54»i(qw-qi)  =  -k3i«<qi>  (17) 

This  algorithm  converges  on  a  very  reliable  way  to  the  exact  solution  of  all  constraint 
equations.  It  can  be  argued  that  the  solution  of  system  (17)  is  less  efficient  than  the  solu¬ 
tion  of  equation  (16),  mainly  because  of  the  pr^uct  of  matrices  in  the  LHS.  However, 
practical  experience  has  shown  that  even  for  non  redundant  systems,  eq.  (17)  can  be 
more  efficient  than  its  counterpart  (16).  The  reason  is  that  in  large  MBS,  the  Jacobian 
tends  to  be  very  sparse,  and  then  the  product  of  matrices  can  be  carried  out  very  effi¬ 
ciently.  System  (17),  although  often  less  sparse  than  (16),  has  the  advantage  of  being 
symmetric,  with  the  possibility  of  saving  storage  and  using  simpler  pivoting  sttategies. 

fable  1  shows  the  results  in  C^U  msec  for  the  finite  displacement  problem  of  the  spa¬ 
tial  6R  robot  shown  in  figure  2.  The  kinematic  simulation  consists  of  imposing  an  end- 
effector  translation  on  an  elliptic  path  contained  in  a  plane  perpendicular  to  the  robot  ini¬ 
tial  position  plane.  Three  different  conditions  have  been  considered:  standard  N-R,  modi¬ 
fied  N-R,  and  modified  N-R  with  an  improved  initial  approximation  obtained  from  a 
velocity  analysis.  It  can  be  concluded  that  in  this  case  the  improvements  that  result  from 
using  modified  N-R  and  the  velocity  approximation  arc  considerable. 


Standard  N-R 

Modified  N-R 

Mod.  N-R  with  vel.  impr. 

531 

217 

155 

Table  1 .  CPU  relative  times  for  a  finite  displacement  analysis. 


2.1.3.'  Improved  Sparse  Matrix  Techniques.  The  best  way  to  improve  the  efficiency  of 
global  methods  is  to  develop  faster  sparse  matrix  solvers,  Ixtter  suited  for  the  size,  spar¬ 
sity  panem  and  characteristics  of  systems  (15),  (16)  and  (17).  The  best  way  to  do  that  is 
to  introduce  the  topology  of  the  system  into  the  sparse  solver  (see  ’’  aff.ct  al.  (1986)); 
Finally  what  one  finds  is  a  convergence  of  algorithms  and  procedure  ith  the  topologi¬ 
cal  methods  that  will  be  considered  later. 
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VELOCITY  TRANSFORMATIONS:  SPACE  OF  ALLOWABLE  MOTIONS 


2JZ. 

Before  entering  the  study  of  the  dynamic  problems,  we  will  study  in  this  Section  the  j 

possible  or  allowable  motions  that  the  multibody  system  may  have  in  accordance  with  | 

the  constraint  equations.  The  study  of  these  motions  and  the  methods  of  expressing  them  j 

is  a  kinemadc  problem,  that  has  important  implications  in  the  formulation  of  the  differ-  j 

ennal  equations  of  motion.  ‘ 

The  actual  velocity  vector  q  of  a  constrained  MBS,  is  a  vector  that  belongs  to  a  par-  I 

ticular  vector  space  that  can  be  called  the  space  of  allowable  motions  (the  term  motions  \ 

should  actually  be  velocities).  The  study  of  this  vector  space  and  the  ability  to  find  a  ba-  t 

sis  for  it  constitute  very  important  points,  for  both  kinematics  and  dynamics  formula-  | 

dons.  Many  authors  have  been  -explicidy  or  implicidy-  referring  to  it  ^ee  Kamman  and  < 

Huston  (1984);  Kim  and  Vanderploeg  (1986b),  Many  et  al.  (1985),  Kane  and  Levinson  ,! 

(1985),  Huston  (1990),  etc).  The  concept  of  the  space  of  allowable  motions  allows  for  a  j 

simple  and  general  way  to  explain,  on  a  unified  background,  many  different  ideas  and 
formuladons  that  have  been  introduced  in  the  last  yean. 

For  rheonomous  systems  the  analytical  expression  for  the  constraint  equations  is  given 
by  eq.  (15).  Differentiating  this  equation  with  respect  to  time  once  and  twice,  we  obtain  ^ 

=  -*»  (18) 

^4j{q*  r)q=-^»-®qq®c  (19) 

where  the  dot  indicates  total  derivanve  and  the  sub  index  t  partial  derivative  with  respect 
to  time,  Eqs.  (18)  and  (19)  define  vectors  b  and  c,  which  will  be  used  in  Section  3. 

If  all  the  degrees  of  freedom  are  co::crolled  kinematically,  that  is,  if  the  motion  of  ail 
the  input  elements  is  known  as  function  of  time,  eqs.  (18)  and  (19)  constitute  two  - 

systems  of  m  equations  with  m  unknowns  controlled  by  rank  m  matrices.  From  here  on, 
however,  it  will  be  assumed  that  there  are  n  dependent  coordinates  and  (n-m)  fiee  or 
kinematically  undetermined  degrees  of  freedom. 

We  will  introduce  now  a  large  family  of  methods,  in  which  the  independent  velocities 
z  can  be  defined  as  the  projection  of  the  dependent  velocities  q  on  the  rows  of  a  constant 
(not  time  or  position  dependent)  matrix  B  i 

z  =  Bq  (20)  ; 

Eq.  (19)  can  be  augmented  by  eq,  (20)  to  yield  | 

‘*’q|q  =  (5j  (21)  1  i 

Let  us  assume  at  this  point  that  matrix  B  also  fulfills  the  condition  of  having /=n-/R  :  j 

rows  that  are  independent  from  one  another,  and  also  independent  of  the  m  rows  of  Oq.  •  | 

With  these  assumptions,  the  matrix  in  eq.  (21)  can  be  inverted,  and  finding  the  vector  q  | 

involves  the  solution  of  the  following  equation  |  A' 

q  =  [‘**ql '(jUsb  +  R  z  (22)  j  I 

I  B  J  *  I' 

where  S  is  a  matrix  constituted  by  the  m  first  columns  of  the  inverse  matrix  in  eq.  (22),  |  j 

and  R  is  the  matrix  constituted  by  the  f=n-m  last  columns  of  the  said  inverse  matrix.  It  is  |  .t- 


easy  to  show  that  the  columns  of  R  pertain  to  and  generate  the  nullspace  of  matrix  Oq. 
Regarding  the  linear  system  (18).  which  is  undetermined  as  long  as  a  value  is  not  given 
to  the  input  velocities,  cq.  (22)  indicates  that  the  general  solution  of  the  system  is  ob¬ 
tained  as  the  sum  of  a  particular  solution  of  the  complete  equation  (term  Sb),  plus  the 
genr.ral  solution  of  the  homogeneous  equation  (term  Rz). 

'fhe  result  of  equation  (22)  may  be  compared  with  the  terminology  commonly  used  in 
Kane's  method  (Kane  and  Levinson  (1985)).  The  columns  of  matrix  R  are  the  partial 
velocities  with  respect  to  the  generalized  coordinates  z,  and  the  term  Sb  constitutes  the 
partial  velocities  with  respect  to  time. 

The  acceleration  equation  can  be  obtained  in  a  similar  manner,  augmenting  eq.  (19) 
with  the  derivative  with  respect  to  time  of  cq.  (20), 


and  the  inversion  of  this  matrix  gives 

q='®q  I  *|x|  =  Sc  +  R  z  (24) 

This  expression,  analogously  to  eq.  (22).  indicates  that  matrix  R  can  be  calculated  by 
triangularizing  the  leading  matrix  of  systems  (21)  or  (23),  and  performing /forward  and 
backward  substitutions,  with  the/ last  columns  of  unit  matrix  1  as  the  RHS  terms. 

Some  of  the  dynamic  formulations  that  will  be  seen  in  Section  3,  require  the  calcula- 
don  of  the  term  (Sc)  in  eq.  (24).  From  this  expression,  it  is  concluded  that  this  term  is  the 
dependent  acceleradon  vector  q  when  z  is  zero.  Since  the  leading  matrix  of  system  (23) 
has  been  previously  triangularized  (when  finding  matrix  R),  the  calculadon  of  the  term 
being  considered  requites  very  little  addidonal  effon. 

Many  methods  currently  used  to  determine  a  basis  of  the  subspace  of  allowable  mo¬ 
tions,  that  is  to  say  matrix  R,  can  be  considered  inside  a  large  group  -the  projection 
methods-  which  will  be  described  next. 

It  is  clear  that  eqs.  (20)-(24)  completely  define  the  transformarion  between  dependent 
and  independent  variables.  This  only  leaves  matrix  B  to  be  determined.  Once  this  matrix 
is  calculated,  it  can  remain  constant  during  a  large  range  of  motion  of  the  system.  The 
condition  that  matrix  B  must  comply  with  is  that  its  (n-m)  rows  must  be  independent 
from  one  another,  and  independent  from  the  m  rows  of  matrix  <bq.  At  this  point,  we  can 
identify  and  describe  in  this  context,  three  methods  that  have  been  proposed  in  the  litera¬ 
ture  to  construct  the  matrix  B. 

1.  Method  based  on  the  Singular  Value  decomposition.  The  SV  decomposes  a  (mxn) 
rectangular  matrix,  such  as  Oq,  in  the  form 

Oq  =  U'^DV  (25) 

where  matrix  U  is  onhogonal  of  size  (mwn).  Matrix  D  is  compose'*  of  a  diagonal  ma¬ 
trix  of  size  (mxm)  that  contains  the  singular  values,  and  a  zero  matrix  given  by /=n-m 
last  columns.  Matrix  V  is  onhogonal  of  size  (nzn),  and  can  be  decomposed  into  two 
sub-matrices  and  V;  of  sizes  (mxn)  and  (fxn),  respectively,  according  to  the 
partition  in  D  The  most  important  propeny  of  the  SV  decomposition  that  pertains  to 
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the  problem  at  hand  is  that  the  rows  of  the  matrix  Vj  constitute  an  orihogottal  basis  of 
the  nulispac^  of  matrix  <!>,.  In  other  words,  it  is  verified  that 

OqVfaO  (26) 

i 

In  view  of  this  expression,  Singh  and  Likins  (1985)  proposed  to  construct  matrix  R  I 

directly  from  the  SV  decomposition.  The  problem  is  that  the  SVD  is  essendally  an  it- 
eradve  process,  which  consumes  a  gr^at  deal  of  time,  and  it  is  absolutely  impracdcal 
to  carry  out  it  at  each  posidon  q  of  tb-  system.  Mani  et  al.  (1983)  have  proposed  us¬ 
ing  the  SV  decomposidon  to  calculate  the  matrix  B,  whereby  this  operadon  only  ! 

needs  to  be  peifonned  once  or  at  mo:.t  a  few  dmes  liixoughout  the  entire  range  of  the 
modon  of  the  system.  Bear  in  mind  that  matrices  R,  corresponding  to  different  , 

posidons  q  cf  the  system,  can  be.  calculated  iVo' n  onlv  one  matrix  B,  that  condnues  to  ■ 

be  valid  as  long  as  its  rows  are  inder-..ndeni  fiom  u.,..  f  Eq-  (26)  indicates  | 

that  matrix  Vj  complies  with  the  corclit‘’ons  retf  red  for  matrix  B,  at  least  as  long  as  i| 

no  large  changes  aie  produced  in  the  jpost  -’s  in  matrix  so  that  the  linear  l 

independence  condition  between  the  rows  o/  u.c  :.tMa  matrix  and  tnose  of  matrix  B  is 
lost. 

2.  Method  based  <.  t  the  Qk  decompof  '  ^  This  method  is  similar  to  the  previous  one,  i 

but  it  uses  th"*  f  .  'nsiead  of  the  f.  V  : '  mposidon,  because  the  QR  decomposidon  is 
a  direct  and  cheaper  i  r  >cess  (Kir.,  V,  nderploeg  (1986b)).  The  QR  tnethod  de¬ 
composes  the  ms  j  X  «l>q  in  the  form 


(27) 

where  Q  sr  orth  .-einal  («x.r)  nr’  5y,  '<no  T  ir  a  r.  rtangular  (nxm)  matrix,  formed 
by  an  uppt«  c- '  ^ .  .•  matrix  (.ncr  .  nd :  ;e -o  ,„ac  x  of  order  (fim).  Note  that  a  dlde 
has  been  iv  <l  lO  d;  /  --j  iish  he  result  c  u..  QR  decomposition  ^m  the  matrix  Q 
that  symbolizes  the  exte  niu  forces  in  d>  tan  .  '  analysis  (S-;don  3),  and  the  matrix  R 
(basis  of  the  lacooian  niillspace).  The  application  of  this  decomposition  to  the 
problem  at  hand  is  straightforward  when  considering  that  the  /  last  columns  of  Q 
constitute  an  orthogonal  basis  of  the  nuilspace  of  the  matrix  that  can  be  taken  as 
matrix  B.  in  the  same  way  as  in  the  SV  d^'omposition. 

3.  Metfiod  bas'td  on  '..  .aiAtiVy:  mangulamcdon.  Tnis  method,  described  by  Serna  et  al. 
(1982),  is  b'ised  on  the  Gauss  friangularization  of  matrix  with  total  piv/^ning.  This 
implies  the  dteomposidon  of  tb v  lacobh  r.  in  sub-matrices,  in  the  form 

(28) 

where  matrix  <I>q  is  a  square  matrix  (mxm)  tb'it  o'/tains  the  columns  in  which  the  piv¬ 
ots  ha-,  c  appeared.  Matrix  Oq  cornins  die jiuiiins  in  which  the  pivots  have  not  ap¬ 
peared,  and  hns  the  size  .(mx/).  In  the  theory  of  linear  equation,  the  variables 
associated  with  j:olumns  are  called  independent  variables,  and  those  associated 
with  columns  <I>q  are  called  dependent  varieties.  Once  matrix  <I>q  is  triangularized  as 
in  cq.  (28),  mauix  B  is  a  boolean  matrix  constructed  as  follows 

B  s  [  0  I  I  ]  (29) 

where  I  is  a  (fxf)  unit  matrix.  The  matrix  from  whose  inverse  matrix  R  is  calculated. 


irfrr'^i  I  r.  - 


Since  mairix  Oq  is  triangularizabie.  it  is  guaranteed  that  the  rows  of  matrix  B  are  in-  | 

dependent  from  those  of  Oq.  Note  that  the  trianguiarization  of  (30)  is  simpler  than  | 

with  the  SV  or  QR  decomposition,  because  in  the  pan  corresponding  to  matrix  B  no  I 

additional  work  is  necessary.  Eqs.  (20)  and  (29)  in^cate  that  the  independent  veloci-  \ 

ties  z  are  chosen  as  a  subset  of  the  dependent  velocities  q.  ! 

12.  TOPOLOGICAL  SOLUTION  METHOD 

An  obvious  way  to  improve  the  efficiency  of  the  finite  displacement  method  previously 
explained  is  to  take  into  account  the  topology  of  the  system  to  be  analyzed.  It  is  known  , 

that  open  chain  MBS  driven  by  relative  coordinates  allow  a  simple  and  efficient  recur¬ 
sive  solution.  Closed  chains  can  also  benefit  from  this  open  chain  formulation,  with  some 
modifications.  This  is  considered  with  more  detail  by  Jimdnez  et  al.  (1993).  Here  we  will 
give  a  very  short,  qualitative  description  of  the  topological  methods. 

I 

2.3.1.  Open  Chain  Systems.  We  will  be  consider  an  open  chain  system  such  as  the  one 
shown  in  figure  3.  For  such  a  system,  the  relative  or  joint  coordinates  also  constimte  a 
possible  set  of  independent  coo^inates.  If  this  is  the  case,  the  finite  displacement  prob¬ 
lem  can  be  solved  directly,  avoiding  the  solution  of  any  system  of  linear  or  nonlinear 
equations. 

In  a  system  with  a  tree  configuration,  if  a  relative  coordinate  is  incremented  this  mo-  ■ 

tion  affects  only  to  the  bodies  that  are  upwards  in  the  conersponding  branch  of  the  tree.  ; 

It  is  very  easy  to  compute  the  new  Canesian  position  of  these  bodies.  If  many  relative  ! 

coordinates  are  incremented  it  suffices  to  go  over  the  tree  recivsively  affecting  to  each  •] 

body  of  the  finite  displacements  of  the  joints  that  are  backwards  in  the  tree.  ^ 

It  is  also  interesting  to  consider  that  in  an  open  chain  system  it  is  very  easy  to  compute  ; 

the  matrix  R  that  relates  Cartesian  with  relative  velocities.  Instead  of  solving  a  system  of 
linear  equations  as  in  (22),  all  columns  of  R  can  be  computed  by  introducing  a  unit  rela¬ 
tive  velocity  in  the  corresponding  joint  (zero  velocity  in  the  other  joint  coordinates)  and  1 


computing  the  Cartesian  velocities  in  the  upward  bodies  in  the  tree.  This  is  a  very  simple 
and  cheat)  recursive  mocedure. 


The  Newton-Raphson  iteration  equations  can  be  set  in  the  partitioned  form 


whose  soludon  can  be  computed  as 

=  Aqb) 

(of  -  of  0,“  of)  Aq»  .  <  o,“  r 

It  can  be  seen,  in  figure  6  and  in  eq.  (32),  that  the  larger  system  of  linear  equations  to 
be  solved  is  based  on  a  lower  triangular  matrix  this  matrix  corresponds  to  the  open 
chain  system.  The  closure  condition  of  the  loop  introduces  a  small  system  of  three  equa¬ 
tions.  It  can  be  useful  to  remember  that  the  Jacobian  of  an  open  chain  system  can  always 
be  arranged  in  a  triangular  form,  that  of  course  do  not  ne^  to  be  factorized.  It  is  also 
worth  to  remember  that  forward  and  backward  substitutions  with  an  sparse  triangular 
matrix  are  computationally  equivalent  to  forward  and  backward  recursive  processes. 


3.  Dynamic  Analysis  of  Multi*Rigid*Body  Systems 

3.1.  GLOBAL  FORMULATIONS 

This  Section  deals  with  the  direct  dynamic  problem.  The  position  of  the  multibody  sys¬ 
tem  is  characterized  by  its  dependent  coordinates.  However,  at  the  time  of  formulating 
the  equations  of  motion,  it  is  possible  to  do  it  with  dependent  or  independent  coordinates. 
There  is  not  a  consensus  among  the  experts  as  to  which  method  is  the  best  for  all  cases. 

We  discuss  in  this  Section  several  methods  of  formulating  and  solving  the  direct  dy¬ 
namic  problem  with  both  dependent  (Section  3.1.1)  and  independent  coordinates 
(Section  3.1.2). 

3.1.1.  Formulations  in  Dependent  Coordinates.  The  formulation  the  equations  of 
motion  with  dependent  coordinates  can  be  obtained  by  either  the  Lagrange's  equations  or 
the  method  of  virtual  power.  Hereinafter,  the  vector  q  will  represent  a  set  of  n  unknown 
dependent  coordinates,  m  will  be  the  total  number  of  independent  constraint  equations 
(geometric  and  kinematic)  and  therefore  f=n-m  will  be  the  number  of  dynamic  degrees 
of  freedom.  The  constraint  conditions  are  written  in  the  following  general  form 

«Kq.t)  =  0  (33) 

By  using  the  Lagrange  equations  or  the  vinual  power  principle,  it  is  possible  to  arrive 
to  the  following  system  of  dynamic  equilibrium  equations 

Mq  +  oj2,  =  Q  (34) 

whpre  vector  Q  contains  the  external  and  the  velocity  dependent  inertia  terms.  The  term 
(♦q  X)  corresponds  to  the  constraint  forces,  that  is,  the  forces  necessary  to  enforce  the 
constraint  equations. 
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3.1.1. 1.  Method  of  the  Lagrange's  Multipliers.  Eq.  (34)  has  «  equations  and  (n+m)  un¬ 
knowns:  the  n  elements  of  vector  q  and  the  m  elements  of  vector  X.  In  order  to  have  a 
sufficient  number  of  equations,  it  is  necessao'  to  supply  m  more  equations.  The  obvious 
choice  is  to  use  the  algebraic  constraint  equations  (33)  which  along  with  (34)  constitute  a 
set  of  differential  algebraic  equations  or  DAEs  of  index  three.  In  order  to  avoid  DAEs 
one  can  use  the  acceleration  kinematic  equations,  which  are  obtained  by  differentiating 
the  constraint  eqs.  (33)  twice  with  respect  to  time 

Oqq=-®,-®qq»c  (35) 

this  expression  defines  vector  c.  By  writing  expressions  (34)  and  (35)  jointly,  one  obtains 


M  Oq 
0 


(36) 


which  is  a  system  of  (n+m)  equations  with  (n+m)  unknowns,  whose  matrix  is  symmetric, 
non  positive  definite,  and  sparse. 

The  main  advantage  of  the  dynamic  formulation  in  dependent  coordinates  using 
Lagrange's  multipliers,  besides  of  the  conceptual  simplicity  of  the  method,  is  that  of 
permitting  the  calculation  of  forces  associated  with  the  constraints  -which  depend  on  the 
Lagrange's  multipliers-  with  a  minimum  additional  effon. 

3. 1.1. 2.  Method  Based  on  the  Projection  Matrix  R.  A  second  possibility  of  formulating 
the  motion  differential  equations  with  dependent  coordinates  is  based  on  the  matrix  R, 
introduced  in  Section  2.2.  Remember  that  the /=n-m  columns  of  R  represent  a  basis  of 
the  nullspace  of  <I>q;  that  is,  a  basis  of  the  subspace  of  possible  motions.  If  th*  dynamic 
equilibrium  eq.  (34)  is  pre-multipiied  by  R*^  and  one  takes  into  account  that  matrices  Oq 
and  R  are  orthogonal 

R'''Mq  =  R'^Q  (37) 

Eq.  (37)  contains  (n-m)  equations  with  n  unknowns.  In  order  to  have  as  many  equa¬ 
tions  as  unknowns,  it  is  necessary  to  complete  this  system  with  the  kinematic  accelera¬ 
tion  eqs.  (35),  resulting  in 


RTM 


q= 


i  v> 

Wq 


(38) 


which  is  a  system  of  n  equations  with  n  unknowns,  that  can  be  solved  for  the  dependent 
accelerations  q.  Note  that  the  upper  pan  of  eq.  (38),  corresponding  to  matrix  Oq,  has 
been  previously  factorized  in  order  to  calculate  the  matrix  R.  Because  of  this,  the  system 
of  eqs.  (38)  can  be  solved  with  very  little  .:dditional  effort,  and  this  method  is  sometimes 
more  efficient  than  the  one  based  on  eqs.  (36)  (Unda  et  al.  (1987)).  The  dynamic  formu¬ 
lation  whpse  end  result  is  eq.  (38),  was  introduced  by  Kamman  and  Huston  (1984),  al¬ 
though  they  did  not  use  a  general  matrix  R,  but  a  set  of  eigenvectors  associate  with  the 
zero  eigenvalues  of  the  matrix  (oIOo)- 

Matrix  R  can  be  calculated  by  means  of  any  of  the  methods  referenced  in  Section  2.2, 
although  in  general  the  simplest  is  the  projection  method,  based  on  the  selection  of  the 
independent  coordinates  as  a  sub-set  of  the  dependent  ones. 
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Eq.  (36)  allows  us  to  clearly  distinguish  the  equations  corresponding  to  the  kinematics 
-the  m  first  ones-,  from  the  equations  corresponding  to  the  dynamics  -the  (n-m)  last 
ones-.  Besides,  system  (38)  does  not  explicitly  contain  any  independent  coordinates, 
rather  they  are  implicitly  considered  via  the  matrix  R.  Each  matrix  R  implies  a  choice  of 
independent  coordinates. 

It  is  known  that  the  time  integration  of  the  dependent  accelerations  that  come  from 
eqs.  (36)  or  (37)  leads  to  severe  unstability  problems.  In  order  to  avoid  that  it  is  neces¬ 
sary  to  integrate  a  mixed  system  of  DAEs  or  to  use  special  stabilization  techniques  as  the 
one  due  to  Baumgane  (1972). 

3. 1.1.3.  Penalty  Formulations.  In  this  Section  we  will  present  an  alternative  formuiadon 
in  dependent  coordinates  based  on  the  penalty  method,  proposed  by  Bayo  et  al.  (1988), 
This  formuiadon  eliminates  the  Lagrange's  muldpliers  foom  the  equadons  of  modon,  and 
leads  to  a  set  of  n  ordinary  d:''".-  rf  ’  so’  .■.•.:ons  with  q  as  the  only  unknowns.  In 
essence,  this  method  direcdy  .  ../{.uratts  the  vfoladon  of  constraints,  penalized  by  a 
large  factor,  into  the  equador'  of  n»o»:.ons.  Ti-  larger  the  penalty  factor  the  better  the 
constraints  will  be  achievec  '.t  cost  of  introducing  some  numerical  ill-condidoning. 
Theoredcal  studies  of  its  con  .ff  ice  and  stability  have  been  carried  out  by  Kurdila  and 
Narcowich  (1992).  In  this  paper  me  penalty  method  will  be  introduced  in  a  very  simple 
way. 

According  to  eq.  (33)  it  can  be  considered  that  vectors  O  and  O  represent  the  vio- 
ladons  for  the  posidon,  velocity  and  acceleradon  constraint  equadons.  On  the  other  hand, 
(34)  shows  that  the  columns  of  Oq  represent  the  direcdon  of  the  constraint  forces.  So 
it  is  {rassible  to  formulate  the  penalty  method  foom  eq.  (34)  by  introducing  very  big 
restoring  forces,  propordonal  to  the  constraint  violadon,  on  the  direcdon  of  the  constraint 
forces.  Eq.  (34)  is  transformed  in 

Mq +Oqa(<b  +  2£2n<i>  +  £2^<t)  =  Q  (39) 

where  matrices  a,  and  n  are  (mxm)  diagonal  matrices  that  contain  the  values  of  the 
penalty  numbers,  the  natut^  frequencies  and  the  damping  ratios,  of  the  1  degree-of-free- 
dom  penalty  system  assigned  to  each  constraint  condition.  If  the  same  values  are  used  for 
each  constraint  these  matrices  become  identity  matrices  multiplied  by  the  respective 
penalty  numbers. 

Note  that  the  term  (a<b  +  2otOp.<i>  +  aQ^O)  is  an  approximation  to  the  true 
Lagrange's  multipliers  X.  The  premultiplication  by  projects  the  forces  unto  the  space 
of  the  dependent  coordinates.  Substituting  O  in  eq.  (39)  the  following  result  is  obtained, 

(M  +  Oq  a  Oq)  q  =  Q  -  Oq  a  (Oq  q  +  *,  +  2  Q  O  -t-  £2^  O)  (40) 

The  condition  of  convergence  for  the  penalty  method  is  achieved  by  merely  using 
large  penalty  factors.  These  in  turn  may  produce  numerical  ill  conditioning,  which  never¬ 
theless  may  be  avoided  by  the  improv^  technique  described  below.  It  is  well  known  that 
penalty  methods  bring  fonh  the  problem  of  choosing  the  right  penalty  number.  It  is  very 
important  that  the  analyst  be  supplied  with  a  method  that  converges,  regardless  of  the 
size  of  the  penalty  values,  to  the  right  solution  within  specified  tolerances  in  the  con¬ 
straints.  To  this  end,  Bayo  et  al.  (1988)  extends  the  augmented  Lagrangian  method 
commonly  used  in  optimization  analysis  to  improve  the  numerical  conditioning  of  the 
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proposed  penalty  equations.  Consider  again  the  classical  Lagrange's  multipliers  method 
as  stated  by  eq.  (34).  Instead  of  following  the  standard  approach,  eq.  (34)  can  be  modi¬ 
fied  by  adding  the  corresponding  penalty  terms,  whose  values  will  be  zero  if  the  con¬ 
straints  are  satisfied.  Therefore 

Mq  +  «l)5a(®  +  2Q)l«&  +  £l^<l>)  +  «l>Jx‘  =  Q  (41) 

This  equation  can  also  be  viewed  as  a  penalty  method  to  which  the  Lagrange's  multi¬ 
pliers  are  added.  In  the  limit,  the  constraint  conditions  are  satisfied,  thus  X^X*  and  eqs. 
(34)  and  (41)  become  equivalent,  except  for  round  off  errors.  In  eq.  (41)  the  Lagrange's 
multipliers  X*  play  the  role  of  correcting  terms.  By  merely  comparing  eqs.  (34)  and  (41) 
it  can  be  infen^  that 

X  =  X*+a(o  +  2Q)ni)  +  n^o)  (42) 

The  solution  of  (41)  without  the  kinematic  constraint  eqs.  (33)  requires  that  the  correct 
values  of  X'*  be  known.  Those  values  are  not  known  in  advance  but  it  is  possible  to  set  up 
an  iterative  process  that  calculates  them  The  iteration  expression  is  easily  established  by 
taking  advantage  of  eq.  (42) 

Xi^,=Xi+a(o  +  2Qjlb  +  Q^4+,  (  =  0,1,2 .  (43) 

with  X^O  for  the  first  iteration.  Eq.  (43)  physically  represents  the  introduction  at  itera¬ 
tion  (i+1)  of  forces  that  tend  to  compensate  the  fact  that  the  constraints  are  not  exactly 
zero.  It  becomes  now  obvious  how  the  penalty  number  does  not  need  to  be  very  large 
since  the  resulting  error  in  the  constraint  equations  will  be  eliminated  by  the  Lagrange's 
terms  during  the  iteration  procedure. 

The  matrix  formulation  of  (41),  including  the  iterative  process  defined  in  (43),  is  given 
by  the  following  expression 

(M  +  ®qa«I>q)qw  = 

T  I  '  ’  2  \  (^) 

=  Mqi-0qa\<I><,q  +  0,  +  2a)l0  +  n  O/  (  =  0, 1,2,... 

with  M  q'o  =  Q  for  the  initial  iteration.  The  subscript  i  represents  the  iteration  number. 
The  extra  numerical  effort  to  perform  the  iterations  is  not  significant,  since  an  iterative 
procedure  is  usually  necessary  to  solve  a  system  of  nonlinear  differential  equations. 

The  penalty  formulation  has  the  advantage  of  having  to  solve  a  set  of  n  equations,  as 
compared  to  (n-fm)  needed  by  the  Lagrange's  multiplier  method.  In  addition,  constraint 
stabilization  is  implicitly  considered  within  the  algorithm,  redundant  constraint  equations 
are  considered  automatically,  the  systems  of  linear  equations  has  a  positive-definite 
matrix  and  it  is  simpler  to  itiiplement  than  the  methods  that  use  independent  coordinates 
which  are  shown  in  the  sequel.  It  has  been  shown  (Bayo  and  Avello  (1993))  that  this 
formulation  is  also  very  robust  with  respect  to  singular  positions. 

3.1.2.  Formulations  in  Independent  Coordinates.  Two  important  advantages  of  this 
type  of  coordinates  are  the  reduction  in  the  number,  of  equations  to  be  integrated,  and  the 
disappearance  of  the  instability  problem  in  the  integfatioti  of  the  constraint  equations 
using  ODE  solvers.  However,  this  has  a  price  in  terms  of  computational  effort  (the  posi¬ 
tion  and  velocity  problems  need  be  solved  after  the  function  evaluations)  and  difficulty 


in  the  implementation  of  some  of  the  numerical  integration  methods,  in  panicular  the 
more  stable  implicit  ones. 

One  point  of  great  importance  in  these  methods  is  the  choice  for  the  right  set  of  inde¬ 
pendent  coordinates;  it  is  closely  related  to  the  methods  to  compute  matrix  R  explained 
in  Secdon  2.2  and  will  not  be  considered  here.  All  that  is  important  to  point  out  is  that, 
usually,  no  system  of  independent  coordinates  is  adequate  for  the  entire  range  of  modon 
of  the  system.  As  a  consequence,  it  is  necessary  to  establish  a  double  acmation  proce¬ 
dure:  on  one  hand  a  method  must  be  developed  that  permits  checking  when  a  set  of  inde¬ 
pendent  coordinates  is  becoming  inadequate,  and  on  the  other  hand,  it  is  necessary  to 
establish  a  method  which  will  permit  finding  the  most  adequate  new  set  of  independent 
coordinates.  Fortunately,  there  are  mathemadcal  properdes  of  the  Jacobian  matrix  Oq, 
that  permit  the  soludon  of  both  problems  sadsfactorily. 

One  last  important  point  should  be  remembered  here:  very  often  the  numerical  inte¬ 
gration  subroutines  of  ordinary  differential  equation  are  based  on  muldstep  methods; 
these  methods  are  very  efficient,  but  they  require  special  techniques  for  starting  the  inte¬ 
gration  process.  Due  to  the  fact  that  each  time  it  is  necessary  to  change  the  independent 
coordinates,  the  numerical  integration  must  be  restaned  again,  it  is  recommended  to 
carry  out  the  nunimum  possible  number  of  coordinate  changes.  On  the  other  hand,  when 
some  determined  coordinates  start  to  be  inadequate,  the  integration  process  becomes 
much  slower.  To  suttunarize,  it  is  necessary  to  arrive  at  a  comprondse  solution,  by  mak¬ 
ing  the  minimum  number  of  coordinate  changes  that  guarantee  quick  and  accurate  nu¬ 
merical  integration. 

The  numerical  integration  process  with  independent  coordinates  requires  solving  the 
position  problem  and  performing  the  velocity  analysis  at  each  iteration.  The  latter  does 
not  constitute  an  important  difficulty,  however,  the  position  problem  does,  because  it  re¬ 
quires  an  iterative  soludon  that  consumes  an  important  amount  of  computational  time. 
For  this  reason  some  authors  as  Paul  (1975)  have  suggested  the  integration  of  the  follow¬ 
ing  extended  Set  of  variables 

y^slz"^,  q”^},  ={z’',  qT},+^  (45) 

where  z  are  the  independent  accelerations.  Because  all  the  velocities  have  been  inte¬ 
grated  (and  not  only  the  independent  ones),  the  new  position  of  the  multibody  system  is 
directly  obtdned  as  result  of  the  numerical  integration.  In  this  numerical  integration  pro- 
ces.s.  tbs  constraint  equation  stabilization  problem  is  not  so  critical  as  in  Section  3.1.1., 
because  the  dependent  variables  that  are  integrated  are  the  velocities,  and  not  the  accel¬ 
erations.  A  lot  of  numerical  experiments  have  shown  that  the  numerical  integration  of 
(45),  complemented  with  checidng  of  constraint  violations  and  the  solution  of  the  posi¬ 
tion  problem  when  this  violation  is  too  large,  provides  an  excellent  compromise  of  speed 
and  preasion. 

It  is  possible  to  compute  dependent  accelerations  ij  by  any  of  the  methods  explained  in 
Section  3,1.1  and  afterwards  to  integrate  numerically  only  an  appropriate  subset  of  inde¬ 
pendent  accelerations  z.  This  procedure  has  been  ciled  coordinate  partitioning  method 
(Wehage  and  Haug  (1982)).  We  will  describe  here  other  family  of  methods  based  on  the 
projection  matrix  R.  In  Section  2.2,  the  following  transformation  between  dependent  and 
independent  accelerations  has  been  introduced 

q  =  R  z  +  (S  c)  (46) 
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By  introducing  this  equation  in  expression  (37),  it  is  obtained 

RTlVlRz  =  kTQ_RTM(Sg)  (47) 

which  constitutes  the  equations  of  motion  in  terms  of  independent  coordinates.  Eq.  (48) 
represents  a  general  matrix  transformation  from  the  vector  spaces  of  dependent  accelera¬ 
tions  and  forces  to  the  vector  space  of  independent  accelerations  and  forces. 

This  formulation  is  valid  for  both  scleronomous  and  rheonomous  constraint  equations. 
In  addition,  this  layout  is  valid,  irrespective  of  the  method  chosen  to  compute  matrix  R. 
Vector  z  doesn't  need  to  be  a  subset  of  vector  q,  but  instead  it  can  be  a  fully  different  set 
of  variables. 

3.1.3.  Comparative  Remarks.  The  penalty  formulation  defined  by  eqs.  (41)  and  (44) 
has  the  advantage,  over  the  formulations  in  independent  coordinates,  that  the  appearance 
or  disappearance  of  constraints  can  be  accommodated  automatically  without  changing 
the  coor^nates,  which  in  turn  avoids  the  restarting  procedure  of  the  numerical  integrator. 
The  penalty  foimulation  is  also  more  suitable  when  the  multibody  system  goes  through  a 
singular  or  bifurcation  position,  because  in  these  cases  the  Jacobian  changes  its  rank.  As 
a  consequence,  and  unless  special  provisions  are  made,  the  formulation  in  independent 
coordinates  (and  even  the  Lagrange's  equations  in  dependent  coordinates)  tend  to  either 
crash  the  simulation  ot  introduce  sudden  large  errors,  whereas  with  the  penalty  formula¬ 
tion  the  term  (M  -»■  <I>q  a  Oq)  in  eq.  (44)  is  free  of  singularities  and  makes  it  be  very  sta¬ 
ble  under  these  circumstances  (for  irxrre  details  see  Bayo  and  Avello  (1993)) 

The  penalty  formulation  (44)  will  tend  to  be  more  efficient  numerically  than  the  for¬ 
mulations  in  independent  coordinates,  simply  because  in  eq.  (44)  the  major  computa¬ 
tional  burden  is  the  ftmnation,  triangularization  and  one  forward  reduction  and  back- 
substitutioti^of  (M  +  Oq  a  Oq).  Since  the  mass  matrix  does  not  modify  the  sparsity  of  the 
product  ((^q  <Pq),  this  operation  is  less  costly  than  the  formation,  triangularization  and  / 
forward  reductions  and  backsubstitutions  of  (<&q  Oq),  required  for  the  formation  of  the 
matrix  R  with  the  least  squares  formulation.  Note,  that  these  algorithms  also  include  the 
formation  and  triangularization  of  (R^MR)  which  represents  an  additional  computational 
burden  of  these  methods. 

3.2.  TOPOLOGICAL  FORMULATIONS 

The  general  purpose  dynamic  formulations  described  in  Section  3.1  are  simple,  but  they 
are  not  suitable  for  very  fast  dynamic  simulation,  that  requires  formulations  that  take  into 
account  the  system’s  topology. 

3.2.1.  Recursive  Formulations.  Historically,  most  of  the  improvements  in  multibody 
dynarmc  formulations  come  from  the  robotics  field.  Walker  and  Orin  (1982)  shown  that 
the  solution  of  the  inverse  dynamics  by  recursive  Newton-Euler  method  allows  a  very 
efficient  formulation  of  the  equations  of  motion.  The  composite  inertia  method  seems  to 
be  the  most  efficient  dynamic  formulation  for  serial  robots  with  N<10,  which  includes 
most  practical  cases.  It  is  a  O(N^)  method. 

Other  authors  (Featherstone  0987))  have  developed  fully  recursive  0(N)  algorithms 
for  open-chain  systems.  Although  they  are  not  the  nnost  efficient  in  practice,  the  elegance 
and  attractiveness  of  the  Featherstone’s  formulation  has  exerted  a  strong  influence  on 
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later  developments  that  have  generalized  these  ideas  for  non-serial  (tree-configuration) 
systems  and  closed-loop  systems  (Bae  and  Haug  (1987-88)).  More  recently,  some  inter¬ 
est  has  been  placed  in  looking  for  improved  efficiency  using  0(N3)  variants  of  this 
method  (Bae  et  al.  (1988);  Bae  and  Won  (1990)). 

Summarizing,  the  method  of  Featherstone  proceeds  with  a  triple  recursion  in  the  fol¬ 
lowing  way:  1)  Knowing  the  relative  position  and  velocity  at  the  joints,  the  Canesian  po¬ 
sition  and  velocity  of  all  the  links  are  computed  recursively  forward,  from  i=l  to  i=N.  2) 
Equivalent  or  articulated  inertias  and  forces  are  computed  recursively  backwards,  from 
i=N  to  i=l.  3)  Finally,  the  relative  accelerations  are  computed  recursively  forward  again, 
from  i=l  toi=N. 

These  ideas  have  been  extended  to  MBS  with  nuny  branches  on  a  tree-configuration, 
and  afterwards  to  systems  with  closed  loops.  The  consideration  of  branches  in  the  kine¬ 
matic  chain  is  a  simple  task,  and  more  difficulties  are  found  for  closed  loop  MBS..  These 
can  be  transformed  into  open  chain  systems  by  cutting  a  joint  in  each  closed  loop,  (see 
Bae  and  Haug.  (1987-88)).  In  a  later  work  Bae  et  al.  (1988)  introduced  a  modification 
addressed  to  compute  all  the  relative  accelerations  at  once  by  solving  a  system  of  linear 
equauons,  thus  becoming  an  O(N^)  method. 

3.2.2.  Velocity  Transformations.  More  recently,  Garcfa  de  Jaldn  et  al.  (1989),  Bae  and 
Won  ( 1 990)  and  Bayo  et  al.  (1991)  have  presented  formulations  well  suited  for  real  time 
analysis,  that  are  based  on  velocity  transformations,  similar  to  the  ones  presented  by 
Jerkovsky  (1978)  and  Kim  and  Vanderploeg  (1986a).  We  will  study  in  this  Section  a 
general  and  simple  method  to  formulate  the  dynamic  equations  of  any  open  or  closed 
chain  MBS,  and  which  can  be  parallelized  even  to  the  body  (or  element)  level. 

The  dynamic  formulation  in  independent  coordinates  described  in  Sections  3.1.2, 
based  on  the  projection  matrix  R,  is  simple  and  general.  It  treat  all  systems  in  the  same 
way,  regardless  of  their  topology  and  particular  characteristics.  A  way  to  improve  the  ef¬ 
ficiency  of  this  formulation  is  to  take  advantage  of  the  open  chain  confrgurations  that  the 
multib^y  systems  may  have  or  in  which  they  may  be  transformed. 

Let  us  consider  an  open  chain  multibody  system  that  consists  in  one  or  several 
branches,  which  form  a  tree  structure,  as  shown  in  figure  3.  In  open  chain  systems  rela¬ 
tive  coordinates  are  also  independent  coordinates.  It  has  been  pointed  out  in  Section 
2.3.1.  that  for  open  chains  matrix  R  can  be  computed  directly,  without  forming  and  tri- 
angularizing  the  Jacobian  matrix.  In  addition  to  this,  the  sparsity  pattern  of  R  becomes 
apparent  and  can  be  used  in  subsequent  matrix  operations.  It  is  easy  to  see  that  the  part  of 
the  matrix  R  that  affects  a  particular  link  or  element  can  be  formed  independently  of  the 
rest  of  the  elements.  This  propeny  leads  to  an  body-by-body  treatment  of  the  equations 
of  motion. 

Finally,  it  is  wonh  mentioning  once  again  that,  as  the  columns  of  matrix  R  thus  calcu¬ 
lated  constitutes  a  basis  for  the  nullspace  of  the  Jacobian  matrix,  it  can  be  written 

0,R=  0  (48) 

although  the  constraint  equations  are  never  explicitly  calculated.  Once  the  matrix  R  is 
known,  we  can  use  the  method  for  the  formulation  of  the  equations  of  motion  in  inde¬ 
pendent  coordinates  explained  in  Section  3.1.2.  In  particular,  we  can  use  eq.  (47).  The 
matrix  R  may  be  obtained  in  an  body-by-body  basis,  considering  separately  the  rows 
that  correspond  to  the  dependent  velocities  of  a  particular  body;  this  opens  very  good 
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deformation  plays  an  important  role,  as  it  happens,  for  instance,  in  light-weight  spatial 
structures  and  manipulators  or  in  high-speed  machinery.  The  dynamics  of  those  systems 
is  influenced  by  the  deformation  and  thus  the  formulations  of  the  preceding  Sections 
cannot  be  applied.  The  complexity  of  the  equadqns  of  motion  considering  deformation 
grows  considerably,  and  so  dees  its  size,  since  the  variables  defining  the  deformation 
must  also  be  considered. 

Due  to  strong  space  limitations,  it  is  not  possible  to  do  here  an  overview  on  the  meth¬ 
ods  presented  in  the  literature  for  the  analysis  of  flexible  multibody  systems.  Instead,  we 
will  concentrate  on  the  developments  carried  out  by  the  authors  in  the  last  few  years.  In 
Section  4.1  we  will  describe  a  general  method  based  on  moving  frame  approach  with 
natural  coordinates,  that  can  be  used  when  the  elastic  displacements  are  small  and  linear 
mode  superposition  can  be  applied.  In  Section  4.2  we  will  present  a  formulation  for 
beam-like  elements  based  on  the  large-displacement  theory,  that  uses  the  same  kind  of 
Canesian  variables  joints  and  unit  vectors-  described  previously.  Both  methods  can  be 
used  together,  including  also  rigid  bodies  modeled  as  explained  before.  The  use  a  com¬ 
mon  set  of  Cartesian  coordinates  is  on  the  basis  of  such  general  approach. 

4.1.  THE  CLASSICAL  MOVING  FRAME  APPROACH 

In  this  method  two  kinds  of  variables  are  considered.  First,  the  rigid  body  variables,  that 
express  the  large  nonlinear  overall  motion  of  the  moving  frame  attached  to  each  t^y; 
second,  the  deformation  variables,  that  express  the  state  of  deformation  of  each  body 
with  respect  to  its  moving  frame.  The  relative  elastic  displacements  are  assumed  to  be 
small,  so  that  the  linear  theory  of  elasticity  holds.  It  is  possible  to  take  as  deformation 
variables  the  nodal  displacements  resulting  from  a  finite  element  discretization  of  the 
flexible  body,  but  this  may  lead  to  a  large  number  of  unknowns.  One  way  of  reducing  the 
size  of  the  problem  consists  in  assuming  that  during  the  motion  only  a  few  deformation 
modes  will  be  excited  and  in  taking  the  amplitude  of  such  modes  as  unknowns.  This  is 
the  popular  substructuring  technique  called  component  mode  synthesis,  described  by 
Hurty  (1965)  and  used  for  MBS  by  Shabana  and  Wehage  (1983).  For  a  general  descrip¬ 
tion  of  this  technique  see  Shabana  (1989).  A  major  advantage  of  the  moving  frame  ap¬ 
proach  is  that  it  m^es  use  of  the  classical  linear  tinite  element  theory  to  intr^uce  either 
the  nodal  variables  or  the  assumed  mode  shapes.  Some  of  the  limitations  of  this  method 
have  been  pointed  out  by  Kane  et  al.  (1987),  who  showed  that  the  moving  frame  ap¬ 
proach  with  linear  elasticity  fails  to  consider  the  rotational  stiffening  and  other  second 
order  effects  that  appear  at  very  fast  speeds  of  operation. 

Next  we  will  describe  the  moving  frame  method  using  the  natural  coordinates.  A 
slightly  different  approach  can  be  found  in  Vukasovic  et  al.  (1990). 

4.1.1,  Kinematics  of  a  Dtformable  Body.  Consider  the  flexible  body  shown  in  figure  7. 
The  moving  frame  is  rigidly  attached  to  it  at  point  O.  The  position  vector  of  a  generic 
point  P  can  be  expressed  as 

r  =  ro  +  A  r  =  ro  +  A(r„  +  u) 

where  the  local  position  vector  r  is  expressed  as  its  value  in  the  undeformed  contigura- 
tion  Tn  plus  the  elastic  displacement  in  the  moving  frame  u.  Matrix  A  is  the  rotation  ma- 
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trix.  This  elastic  displacement  can  be  expressed  as  a  linear  combination  of  static  and  dy¬ 
namic  modes,  in  the  form 

(55) 


j-i 


where  <!>;  and  'F,  are  the  static  and  dynamic  modes,  and  Tii  and  the  corresponding 
modal  amplitudes  (in  number  N,  and  Na.  respectively).  In  this  formulation  the  disdnedon 
between  stadc  and  dynamic  modes  is  very  important  because,  as  it  will  be  seen  in  the  se¬ 
quel,  they  are  managed  in  a  completely  different  way. 


n. 


Figure  7.  Deformable  body  with  fixed  and  moving 
frames. 


Figure  8.  Flexible  beam  element  in  the 
undefotmed  configuration. 


In  this  formuladon  for  flexible  MBS,  points  and  unit  vectors  are  defined  on  the  joints 
and  joint's  axes  exactly  on  the  same  way  explained  previously  for  rigid  bodies,  so  as  to 
be  able  to  define  the  joints  and  joint's  constraints  in  the  same  way  (this  is  considered  as 
essendal  so  as  to  be  able  to  mix  rigid  and  flexible  bodies  in  the  analysis  of  a  single 
MBS).  The  static  modes  are  the  deformadon  modes  that  result  of  introducing  reladve 
displacements  between  the  points  and  vectors  that  belong  to  a  deformable  body.  On  the 
other  hand,  the  dynamic  modes  describe  internal  deformadon,  i.e.,  deformadon  states  that 
keep  constant  the  relative  position  of  points  and  unit  vecto.'s.  We  will  present  this 
formuladon  using  a  simple  example:  the  beam  element  shown  in  figure  8. 

In  the  element  shown  in  Hgure  8  we  will  consider  two  points  ro  and  rj,  and  four  unit 
vectors.  Some  of  this  unit  vectors  shall  be  chosen  according  with  the  axes  orientadon 
both  joints.  Point  ro  is  the  origin  of  the  moving  frame  and  the  vectors  u,  v  and  w,  that  are 
mutually  orthogonal,  define  the  orientadon  of  the  moving  reference  frame  axes.  The  ro- 
tadon  matrix  A  can  be  expressed  as 

A  =  [ulvlw]  (56) 

Let  us  consider  the  stadc  modes  of  the  body  in  Hgure  8.  The  modes  O;  (i  =  1, 2, 3)  are 
obtained  by  introducing  unit  displacements  of  point  ri  on  the  direcdops  (^,  y,  t),  respec- 
dvely.  These  static  modes  are  displayed  in  figure  9.±lote  that  mode  4>i  produce  a  defor¬ 
madon  in  the  (x,  y)  plane;  the  deformadon  of  mode  <[>2  >s  an  axial  deformation  on  the  di¬ 
rection  of  axis  y;  and  the  deformation  of  mode  O3  is  contained  in  the  plane  (y,  z).  Note 
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also  the  difference  between  modes  and  O3  at  point  ri:  in  mode  Oi  the  beam  is  free  to 
rotate  around  ni,  while  in  mode  O3  rotation  is  forbidden  because  vector  iii  shall  maintain 
its  direction. 


Figure  9.  Static  modes  due  to  displacements  of  a  poinu 

In  figure  10  the  twQjtatic  modes  that  result  from  variation  of  the  (x,  y)  components  of 
ni  are^hown.  Mode  O4  is  a  torsion  mode  due  to  a  variation  in  the  component  x  of  m; 
mode  is  a  bending  mode  in  the  plane  (y,  z)  due  to  a  variation  in  the  component  y  of 
ni.Note  that  in  this  case  a  bending  of  the  beam  at  point  ri  with  respect  to  vector  nj  is  not 
related  with  a  variation  in  the  natural  coordinates,  so  it  is  considered  as  an  internal  de¬ 
formation  that  shall  be  determined  by  the  dynamic  modes  (sec  figure  11). 


Figure  10.  Static  modes  due  u>  variations  in  a  unit  vector. 

The  main  point  with  respect  to  static  modes  is  that  their  amplitudes  Tii  (i  =  1,  ...4)  can 
be  computed  from  the  relative  variation  of  nanual  coordinates  (Canesian  coordinates  of 
points  and  unit  vectors),  so  they  do  not  need  to  be  considered  as  mechanism  coordinates. 
We  will  see  how  this  can  be  done  for  the_Oexible  element  we  are  considering. 

Taking  into  account  that  static  modes  (i  =  1, 2, 3)  have  been  computed  by  introduc¬ 
ing  unit  displacements  for  point  n,  the  rei  amplitudes  of  these  static  modes  can  be  eas¬ 
ily  computed  in  the  moving  frame  from  the  expression, 

^r,  =  ri-ri„  (57) 

In  Older  to  compute  these  amplitudes  as  a  function  of  the  natural  coordinates  we  can 
use  the  following  coordinate  transformation 


?!  -  To  =  (ri  -  ro) 


(58) 


Taking  into  account  that  ro  ®  0,  substituting  cq.  (58)  into  eq.  (57)  we  obtain  the  ex¬ 
pression  of  static  modal  amplitudes  in  terms  of  the  natural  coordinates. 
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tlr,  =  AT{ri-ro)rrin  (59) 

where  ?]„  is  a  constant  vector  and  matrix  A  is  determinedi  from  eq.  (56).  In  an  analogous 
way  it  is  possible  to  compute  the  modal  amplitudes  corresponding  to  the  static  modes 
that  originate  from  the  unit  variadon  of  the  components  of  vector  U|.  It  is  obtained 

=  (60) 

where  only  two  of  the  three  components  make  sense  in  this  particular  case.  It  has  been 
shown  that  static  modes  do  not  introduce  additional  global  coordinates  in  the  anaiysis. 


Figure  12.  Differemiai  mass  elemem  in  a  flexible  body. 

On  the  other  hand,  dynamic  modes  have  been  defined  as  internal  deformation  modes, 
i.e.,  modes  that  do  not  produce  variation  on  the  natural  coordinates  of  the  beam.  Figure 
1 1  shows  three  dynamic  modes  that  have  been  computed  as  the  eigenveaors  (natural 
modes)  of  the  beam  with  the  boundaries  clamped  so  as  to  do  not  allow  variatioQjn  the 
C^esian  coordinates  of  the  points  and  unit  vectors.  It  can  be  seen  that  tirade  Xi  is  a 
bending  mode  in  plane  (x,  y)  with  free  rotation  around  unit  vectQLUi;  mode  ^2  ^ 

bending  mode  in  the  plane  (7,  z)  with  both  ends  clamped  and  mode  is  a  second  mode 
in  the  same  plane  with  the  same  boundary  conditions.  Note  that  there  are  a  finite  number 
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of  static  inodes,  but  an  infinity  of  dynamic  modes,  although  only  a  few  of  them  need  to 
be  included  in  the  analysis  (those  that  one  expects  that  will  be  excited  during  the  dy¬ 
namic  analysis).  In  some  cases  only  some  stadc  modes  -perhaps  not  all  of  them-  will  be 
enough  to  get  the  desired  precision. 

Of  course,  the  amplitudes  of  dynamic  modes  (i  »  1,  2,  ..  are  independent  of  the 
Cartesian  natural  coordinates,  and  shall  be  included  among  the  unknowns  to  be  inte¬ 
grated  during  the  dynamic  simulation. 

The  extension  of  the  concepts  and  ideas  presented  in  this  Section  to  more  complex 
flexible  bodies  is  straightforward.  Static  and  dynamic  modes  can  be  computed  with  a  fi¬ 
nite  element  code  by  imposing  the  appropriate  boundary  conditions. 

4.1.2.  Dynamic  Equations  and  Constraint  Equations.  Once  the  deformation  modes 
have  been  defined,  it  is  possible  to  formulate  the  motion  differential  equations.  In  this 
case  we  will  use  the  vinual  power  principle.  Consider  the  flexible  body  shown  in  figure 
12.  The  virtual  power  of  inertia  forces  of  this  body  can  be  computed  as 


W 


f  pdV 


Taking  time  derivatives  of  eq.  (54)  it  is  obtained 

r  =  fo  + Ar+ Ar 


and  substituting  in  eq.  (61), 


f  =  fo  +  Xr  +  2Af  +  Ar 


(61) 


(62) 

(63) 


W« J  (fo  +  +  r  A^)  (fo  +  Xr  +  2 Ar  +  A?)  p  d V  (64) 

where  r  and  r  can  be  obtained  by  differentiating  eqs.  (54)  and  (55),  in  which  only  T|,  and 
^jaie  functions  of  time.  Although  it  is  not  possible  to  fully  expand  here  this  equation,  it  is 
interesting  to  consider  one  term  and  to  remenber  where  are  the  problem  variables 
(natural  coordinates  and  cynamic  modal  coefficients);  let  us  consider  for  instance  the 
tcrni, 
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fo  A  r  p  dV 


(65) 


In  this  integral  term  Tq  is  a  natural  dependent  velocity.  Other  dependent  velocities  ap¬ 
pears  in  matrix  A,  that  according  to  eq.  (56)  is  the  matrix  [li  I  v  I  w].  From  eq.  (62),  r 
contains  the  natui^  coordinates  (u,  v,  w),  the  natural  velocities  (fo  I  u  I  v  I  w)  and  the 
modal  velocities  tii  and  However,  according  to  eqs.  (59)  and  (60),  the  static  modal 
velocities  f)i  can  be  expressed  in  terms  of  the  natural  velocities  (fo  I  f]  I  u  I  v  I  w).  The 
algebraic  manipulations  are  straightforward,  but  too  long  to  be  reproduced  here.  The 
volume  inte^ratioojn  eqs.  (^  and  (65)  applies  to  the  undeformed  local  coordinate  r„,  to 
the  modal  sh '  ies  O/r.,)  and  and  to  the  material  density  p. 

Finall'/,  w.  -ive  to  an  expression  in  the  form 


W*qJ(M.q.+QVe) 


(66) 
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where  q,  is  the  vector  that  contains  the  dependent  virtual  velocities  of  the  flexible  body; 
Me  is  the  inerda  matrix  of  the  elementand  Qv^the  vector  containing  velocity  dependent 
inertia  forces. 

Dynamic  equations  for  the  whole  set  of  bodies  can  be  obtained  in  an  analogous  way. 
Internal  reaction  forces  do  not  produce  virtual  power.  It  is  necessary  to  inti^uce  the 
constraint  equations  that  relate  the  natural  coordinates.  This  can  be  carried  out  in  the 
same  way  that  for  rigid  bodies. 

4.2.  LARGE  DEFORMATIONS 

As  mentioned  previously,  the  classical  moving  frame  approach  is  based  on  the  assump¬ 
tion  of  small  displacements.  It  assumes  that  the  equilibrium  condition  is  set  in  the  unde¬ 
formed  configuration.  Because  of  this,  the  method  seen  in  the  previous  Section  cannot 
handle  larger  deformations  than  those  for  which  the  linear  finite  element  method  and 
mode  superposition  yields  accurate  results. 

When  the  second  order  effects  become  important  and/or  displacements  become  finite, 
the  global  or  absolute  method  described  in  this  section  can  be  applied.  We  call  it  global 
or  absolute  because  the  entire  motion  of  the  body  (finite  rotation  plus  deformation)  is  all 
referred  to  a  fixed  frame.  This  produces  a  shifting  of  nonlinearity  from  the  inertia  terms 
in  the  moving  frame  approach,  to  the  deformation  terms  in  this  approach.  A  formulation 
of  this  type  was  first  presented  by  Simo  and  Vu-Quoc  (1986  and  1988),  for  multibodies 
modeled  as  planar  and  three  dimensional  beams,  respectively.  See  also  Cardona  (1989). 

In  this  Section  we  will  assume  that  the  flexible  bodies  are  long  and  slender  and  that 
they  can  be  correctly  modeled  as  oeams.  Timoshenko’s  beam  theory  will  be  used.  With 
this  basic  assumption  we  will  derive  expressions  for  a  simple  nonlinear  beam  element 
that  can  be  used  to  model  flexible  bodies  in  a  multibody  formalism.  Perhaps  the  most  at¬ 
tractive  features  of  this  formulation  art  iu  simplicity  and  the  compatibility  with  the  nam- 
ral  coordinates  so  far  described  in  this  paper,  since  the  nodal  variables  of  this  beam  ele¬ 
ment  are  also  Canesian  coordinates  of  points  and  unit  vectors. 


4.2.1.  Kinematics  of  a  Deformable  Beam.  Figure  13  shows  an  initially  straight  prismatic 
beam  of  length  L  and  constant  cross  section  A.  We  introduce  a  fixed  reference  frame 
(X),  X2,  X}),  with  the  X,axis  coincident  with  the  centroidal  line,  and  axes  Xj  and  X3  co¬ 
incident  with  the  principal  axes  of  inertia  of  the  section.  A  cross  section  of  the  beam  in 
this  initial  state  can  be  described  by  the  point  (Xi,  0, 0)  and  by  two  mutually  orthogonal 
vectors  M  and  N,  parallel  to  the  X2  and  X3  axes.  We  may  think  of  M  and  N  as  co- 
rotational  vectors  that  move  rigidly  attached  to  the  cross  section  to  which  they  belong. 

After  the  beam  has  undergone  tinite  displacements,  we  can  define  the  position  of  its 
cross  sections  with  position  vector  r  and  with  the  co-rotational  vectors  m  and  n.  We  will 
use  upper  case  letters  for  the  undeformed  positions  (material  coordinates)  and  lower¬ 
case  letters  for  deformed  positions  (spatial  coordinates).  The  deformed  positions  can  be 
expressed  as  a  function  of  the  undeformed  ones.  Since  the  undeformed  beam  is  charac¬ 
terized  by  just  the  X,  coordinate  we  can  consider  vectors  r,  m  and  n,  as  a  function  of  Xj 
and  the  time  t,  and  the  deformed  coordinates  xs(xi,  X2,  X3)  of  a  particie  whose  material 
coordinates  arc  X=(Xi,  X2,  X3)  can  be  written  as 

x(X,  r)  =  itX,,r)  +  X2m(X,,f)  +  X3n{Xi,r)  (67) 

where  Xi  is  not  a  function  of  time. 

Now  finite  element  interpolation  will  be  applied.  Classic  Timoshenko  beam  elements 
interpolate  independently  the  displacements  and  rotations.  The  nodal  variables  are  the 
three  displacements  Ui  and  three  small  rotations  6i.  In  a  .similar  way,  we  will  assume  an 
ii'idependent  interpolation  for  the  nodal  variables,  that  will  be  different,  in  nature  and 
number,  from  the  classical  ones.  For  this  element  the  nodal  variables  are  composed  of  tlie 
three  coordinates  of  vector  r>  and  the  six  components  of  the  orthogonal  unit  vectors  m> 
and  n',  as  we  show  in  figure  14. 


Figure  14.  Cartesian  dependent  coordinates  for  a  beam  section. 

The  nine  nodal  variables  (r*.  m',  n')  are  redundant  or  dependent,  because  there  arc 
three  constraint  equations  that  m'  and  n'  must  satisfy  (unit  norm  and  orthogonality  condi¬ 
tions).  Redundant  variables  have  been  extensively  used  in  the  analysis  of  multibody 
systems,  but  seldom  in  the  finite  element  method.  The  use  of  redundant  variables  can  re¬ 
duce  the  complexity  of  the  formulation.  The  cost  that  one  has  to  pay  is  the  introduction 
of  constraint  equations  to  enforce  the  satisfaction  of  the  constraints  at  the  nodes.  For  the 
sake  of  simplicity,  only  two-node  elements  will  be  considered  here. 
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Let  (r‘,  m',  n‘),  i  =  1, 2  oc  the  values  of  (r,  m,  n)  in  the  nodes  that  belong  to  the  beam 
element  (e).  The  values  of  (r,  m,  n)  inside  each  finite  element  are  obtained  through  the 
following  interpolation  scheme 

2  2  2 

r*  =  XNir'.  m*=XNi>n'-  ne=XNini  (68) 

iwl  ial  i*l 

where  Nj  are  the  standard  finite  element  shape  functions.  Note  that  in  eq.  (68)  also  the 
unit  vectors  are  interpolated.  Since  the  shape  functions  art  not  required  to  preserve  the 
norm,  vectors  m*  and  n*  have  no  longer  unit  module  and  they  are  not  orthogonal.  This  is 
a  new  source  of  discretization  errors  that  is  added  to  the  standard  error  of  the  finite 
element  method.  A  full  discussion  on  how  this  error  affects  the  accuracy  of  the  solution 
goes  beyond  the  scope  of  this  paper,  but  it  can  be  pointed  out  that  the  convergence  of  the 
finite  element  method  is  guaranteed,  because  this  error  decreases  with  element  size,  and 
in  addition  to  this  the  numerical  results  obtained  with  this  formulation  are  similar  to  the 
ones  obtained  with  other  nonlinear  formulations  (Avcllo  ct  al.  (1991)). 

In  order  to  obtain  the  inertia  forces  we  first  develop  the  expression  for  the  kinetic  en¬ 
ergy,  which  can  be  obtained  from  the  integral 


X*  dm 


(69) 


The  velocity  of  a  material  point  x*  is  obtained  by  differentiating  expression  (67)  and 
by  substituting  the  interpolation  scheme  given  in  (68),  leading  to 

2 


x*=£Ni(r‘  +  X2m‘  +  X3  ii‘) 
i>I 

Substituting  eq.  (70)  into  (69)  yields 


(70) 


2  2 


£  X  Nj  +  x|  IW  +  x|  n'"’’ nj + 

i=i  j=i 


(71) 


+  2  X2  f'^ rn*  +  2  X3  f'"^ lij  +  X2 X3  ih'^iijjdm 

where  the  only  terms  that  depend  on  the  integral  variables  arc  X2  and  X3.  Since  X2  and 
X3  are  principal  axes  of  inenia,  and  Xj  coincides  with  the  center  of  gravity  of  the  cross 
section,  the  three  last  terms  in  the  integral  vanish  After  reordering  eq.  (71),  the  kinetic 
energy  is  obtained  as 

T'  =  Iq*’^M'q'  (72) 

where  q*”!"  =  {r'f  rn'T  n*7’  r^T is  the  vector  that  contains  the  nodal  variables  of 
element  (c),  and  matrix  M*  is  a  constant  and  symmetric  matrix  composed  of  sparse 
submatrices  My  of  size  (9x9).  In  an  homogeneous  beam,  M®  takes  the  form 

A  Cij  I3  O3  O3 
;  with  Mij  =  p  1  O3  I2  Cii  I3  O3 


M'  = 


Mij  Mjj 

M2J  M22 


O3 

O3 


I2  Cij  I3 

O3  I3  Cij  I3 


(73) 
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where  p  is  the  volumetric  density,  I3  the  (3x3)  unit  matrix  and  Cij  the  integral  over  the 
length  of  the  element  of  the  product  of  shape  functions  (Ni  Nj). 

This  siihple  and  constant  expression  for  the  mass  matrix  can  be  compared  with  the 
highly  nonlinear  matrix  obtained  in  Section  4.1.1.  However,  the  elastic  potential  energy 
is  more  complicated  than  with  the  moving  frame  method. 

One  of  the  basic  assumpdons  often  made  in  smicmral  analysis  is  that  displacements 
and  displacement  gradients  are  small.  When  this  assumption  holds,  the  Cauchy  strain 
tensor  can  be  used  and  gives  accurate  results.  However  it  is  known  that  the  Cauchy  strain 
tensor  does  not  work  for  large  displacements  since  it  does  not  exhibit  the  proper  invari¬ 
ance  under  rigid  body  rotations  of  the  displacement  field.  The  Green  strain  tensor  has 
typically  been  used  in  nonlinear  elasticity  to  characterize  the  deformation  field  of  bodies 
undergoing  large  displacements.  As  the  displacements  and  displacement  gradients  get 
smaller,  the  Green  tensor  tends  to  coincide  with  the  Cauchy  tensor. 

Let  us  consider  a  continuous  body  and  a  fixed  reference  frame.  We  will  use  capital 
letters  X=(Xi,  X2,  X3)  to  refer  to  the  coordinates  of  a  particle  in  the  undeformed  position 
and  lower-case  letters  x=(xi,  X2,  X3)  for  the  deformed  position.  In  the  Lagrangian  for¬ 
mulation  X  is  taken  as  a  function  of  X  and  time,  in  the  form 

x  =  x{X,  r))  (74) 

The  deformation  gradient  F  is  defined  as  the  matrix  that  contains  the  panial  deriva¬ 
tives  of  X  with  respect  to  X.  An  infinitesimal  vector  in  the  deformed  position  dx  can  be 
expressed  in  terms  of  the  deformation  gradient  and  of  its  undeformed  position  dX  as 

dx  =  ^dX  =  FdX  (75) 

The  Green  deformation  tensor  C  is  defined  as  the  tensor  that  relates  the  square  length 
(ds)2  of  vector  dx  with  vector  dX.  Thus 

ds^rtdX'^CdX  (76) 

The  Green  strain  tensor  E  gives,  by  definition,  the  change  in  squared  length  between 
the  deformed  and  the  undeformed  state  of  a  vector  dX 

ds^-dS^  =  2dX’’’EdX  (77) 

where  (dS)^  is  the  original  length  of  vector  dX.  From  eqs.  (75)-(77),  it  can  be  found 

C  =  f’^F;  E  =  (78) 

The  potential  energy  for  a  linearly  elastic  homogeneous  material  can  be  written  in 
terms  of  the  strain  vector  E  =  {Eu  E22  E33  E12  E13E23  as 

V  =  lf  E’^DEdV  (79) 

2;v* 

where  the  integral  is  extended  to  the  body  in  the  undeformed  configuration,  and  where  D 
is  a  diagonal  matrix  defined  in  terms  of  Lame's  constants  X  and  G. 

From  eq.  (67)  the  deformation  gradient  F  can  be  computed  as 

F  =  ^  =  [x.i  |x.2lx.3  ]  =  [r.i+X2in.i+X3n.i  im|n]  (80) 


v  r»*v-vy‘> 


where  the  vertical  bars  in  equation  indicate  the  separation  between  columns.  We  use  the 
notation  to  represent  3(-)/3Xi.  The  Green  strain  tensor  can  be  obtained  by  substitut¬ 
ing  eq.  (80)  into  eqs.  (78),  as 


’‘.T 


; with  X 1  =  Pi  +  X2 m_j  +  X3 n_i 


Substituting  eq.  (81)  into  (80)  and  neglecting  second  order  terms,  after  some  algebraic 
manipulations  the  following  expression  for  the  strain  vector  E  is  obtained, 

Eij  =^(  r^i  r.i  -1+2X2 »n,i  +2X3r]i  n.i):  E22  =  E33  =  0 

Ei2  =  ^(ryi  m  +  X3nJ  m|;  Ei3  =  ^(ryi  n  +  X2mJ  n);  E23  =  0 

which  is  in  accordance  with  the  strain  distribution  predicted  by  the  strength  of  materials 
for  a  prismatic  beam  under  axial,  shearing,  bending  and  torsion  loads.  For  instance,  the 
term  (rji  r,]  - 1)/2  in  Eu  represents  a  constant  strain  distribution  corresponding  to  a  pure 
axial  load.  Analogously,  the  term  (X2  rji  m,i)  in  Eu  represents  a  strain  distribution  that 
varies  linearly  wi^  X2  ,  with  a  zero  value  at  ^e  centroid  and  extreme  values  at  the  edges, 
as  cotresponds  to  a  pure  bending  load. 

Using  eq.  (82)  the  potential  energy  of  a  single  element  can  be  written  as 

n*=^J  [EAri  +  Ei2r|+Ei3r|+GA,2r4  +  GA,3d+Gipr6]dXi  (83) 

where  Fi  represents  the  axial  strain,  r2  and  r3  are  the  bending  unit  rotations  per  unit 
length.  Fa  and  Fs  are  the  shearing  strains,  and  Fs  is  the  torsion  rotation  per  unit  length. 
Their  expressions  are 

- .  r2  =  r^  n.i;  F3  =  r^  m.i;  F4  =  r]^  m;  F5  =  r^  n;  F6  =  n|^  m  (84) 

where  As2,  A53  are  the  equivalent  shear  areas,  and  I2, 13  and  Ip  have  the  meaning 

12  =  1  X|dA  l3  =  JxidA  Ip  =  J  {x?  +  X|)dA  (85) 

We  can  introduce  the  finite  element  interpolation  given  in  eq.  (68)  into  eqs.  (83)  and 
(84).  After  some  algebraic  manipulations  and  rearrangements,  the  following  expressions 
for  the  strains  Fj  are  obtained 

Fi  =  iq'TG’q*-Pi,  i=l,  ...,6  (86) 

with  Pi  =  1  and  P;  =  0,  i  =  2, ... ,  6,  and  where  q*  was  defined  previously.  The  matrices  G' 
are  symmetric,  sparse,  and  depend  only  on  the  shape  functions  and  their  derivatives  with 
respect  to  Xi.  Their  expression  can  be  found  in  Avello  et  al.  (1991).The  total  potential 
energy  for  the  beam  is  obtained  by  adding  the  potential  energy  of  all  the  elements. 

It  can  be  pointed  out  that  in  this  beam  element  the  potential  energy  is  obtained  as  a 
polynomial  of  order  4th  in  the  position  variables  (11®  depends  on  the  square  of  Fi,  and  Fi 
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depends  on  the  square  of  q‘),  unlike  the  moving  frame  formulation  of  Section  4.1.,  in 
which  the  potential  energy  is  a  quadratic  function  of  the  position  variables.  Cenainly, 
this  complicates  the  implementation  of  the  elastic  forces,  but  recall  that  the  mass  matrix 
is  constant  and  that  it  can  be  computed  only  once. 

4.2.2.  Constraint  Equations.  Since  the  position  variables  are  not  independent,  it  is 
necessary  to  introduce  constraints  at  the  finite  element  nodes  and  at  the  joints.  The  con¬ 
straints  at  the  nodes  account  for  the  unit  norm  and  orthogonality  conditions  for  the  unit 
vectors.  The  constraints  at  the  joints  restrict  the  relative  motion  of  adjacent  bodies  to  the 
rotations  or  translations  allowed  by  the  kinematic  joints. 

The  joint  constraint  equations  at  the  joints  can  be  written  in  terms  of  the  nodal  vari¬ 
ables  of  the  nodes  next  to  the  joint.  This  problem  is  fully  analogous  to  the  joint  constraint 
equations  for  rigid  bodies  and  will  not  be  further  developed  here.  Of  course,  the  joint  can 
link  two  flexible  beams,  but  it  can  also  link  a  beam  and  a  rigid  body  or  a  beam  and  a 
flexible  body  computed  with  assumed  deformation  modes.  The  joint  constraints  would 
be  developed  in  the  same  way,  but  different  position  variables  shall  be  used  for  each 
kind  of  bodies. 

4.2.3.  Dynamic  Equations.  The  equations  of  motion  can  be  derived  using  any  of  the 
methods  discussed  previously.  Here,  we  will  use  the  Lagrange’s  multipliers  method.  The 
Lagrangian  L  can  be  written  as 


I 

1 


! 

I 


i 

1 


L  =  T-n  +  0  X  (87) 

where  9  contains  the  constraints  that  arise  from  the  unit  norm  and  orthogonality  condi¬ 
tion  for  the  nodal  variables  at  the  nodes,  and  the  kinematic  constraints  imposed  at  the 
joints.  The  application  of  the  Lagrange’s  equations  leads  to 

Mq  +  «I»JX*Q-F  (88) 

where  M  is  the  mass  matrix  obtained  by  assembling  the  mass  matrices  M*  of  each  ele¬ 
ment,  Oq  is  the  Jacobian  of  the  constraint  equations,  Q  is  the  vector  of  generalized  exter¬ 
nal  forces,  and  F  the  vector  of  elastic  forces,  that  are  obtained  by  differentiating  eq.  (83) 
with  respect  to  q®. 


5,  Optimum  Kinematic  Synthesis  of  Linkages 

The  method  presented  in  this  Section  is  a  contribution  coming  from  Alvarez  and  Jim6nez 
(1992).  It  is  a  good  example  of  how  natural  coordinates  can  also  be  used  to  develop 
computer  programs  for  the  design  of  multibody  systems. 

Kinematic  synthesis  of  mechanisms  is  mainly  a  geometric  problem,  about  which  much 
has  been  written  in  the  past  centuiy  and  in  the  first  half  of  the  present  one  (Erdman  and 
Sandor  (1978)  and  Suh  and  Radcliffe  (1978)).  During  this  time,  many  methods  were  de¬ 
veloped  (the  majority  of  them  were  focused  on  the  planar  four  bar  mechanism),  almost 
all  of  them  graphic  and  containing  a  notable  amount  of  ingeniousness  and  originality. 
The  problems  of  dimensional  synthesis  are  grouped  together  in  three  families;  function 
generation  synthesis,  path  generation  synthesis  and  rigid  body  guidance  synthesis. 
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Figure  IS.  Path  generated  by  a  point  of  the  coupling  Figure  16.  Design  points  for  a  path  generation 
bar.  synthesis. 

Graphic  methods  of  kinematic  synthesis  are  limited  to  simple  mechanisms,  they  tend 
to  be  too  specific,  and  at  times  difficult  to  use.  In  recent  years,  more  general  programs 
for  optimal  synthesis  have  been  developed,  and  are  applicable  to  many  different  types  of 
planar  and  three-dimensional  multibody  systems,  and  include  many  different  design 
conditions  or  specifications.  Normally,  these  methods  are  based  on  numerical  methods 
for  optimization  that  seek  the  optimal  solution  with  a  minimum  degree  of  error. 

In  this  Section,  we  will  describe  a  simple  and  general  numerical  method  for  the  opti¬ 
mal  kinematic  synthesis  of  linkages.  This  method  will  be  described  with  a  path  genera¬ 
tion  problem  for  a  four-bar  example,  but  it  may  be  easily  generalized  for  nearly  any  pla¬ 
nar  or  three  dimensional  linkage  and  synthesis  condition. 

In  order  to  carry  out  the  optimum  design  of  a  multibody  system  for  a  defined  set  of 
design  specifications,  three  steps  shall  be  considered: 

a)  Choose  the  mulubody  system  topology 

b)  Select  the  design  variables 

c)  Define  and  minimize  the  objective  function 

We  will  consider  two  kinds  of  constraint  equations:  geometric  constraints  and  func¬ 
tional  constraints.  The  geometric  constraints  come  fixim  the  multibody  system  topology 
-step  (a)-,  and  are  the  constraints  that  we  have  considered  in  the  previous  Sections  of 
this  paper.  The  functional  constraints  come  from  the  specific  design  requirements  that 
the  muitibody  systems  must  fulfill. 

Let  us  consider  the  path  generated  by  point  3  belonging  to  the  coupler  of  the  four  bar 
mechanism  in  figure  15.  In  this  case  we  will  consider  that  points  A  and  B  can  not  be 
moved,  thus  the  design  variables  are  the  elements  of  the  following  vector 

(jT  =  {djy^,  dj2t  d2B»  X3,  y3)  (89) 

and  the  vector  of  dependent  coordinates  is 

qT={x„yj.X2,y2,X3,y3)  (90) 

In  this  example,  the  geometric  constraints  are  the  constraints  that  correspond  to  the 
four  bar  mechanism  with  three  points  in  the  coupler,  that  are 

<|),  s  (xi  -  Xa)^  +  (y,  -  yj^  -  di^A  =  0  (91) 
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$2H(x,-x2)^  +  (yi-y2)^-di|  =0 
<*>3  s  (x2  -  Xfl)^  +  (y2  -  ys)^  “  d;3  =  0 


(92) 

(93) 


<1)4hX3-X, 


H-%:^X3-^y3  =  0 
di2  di2 


(94) 


‘t'S 


sy3-yi  +  %-^x3  + 

012 


di2 


y3  =  o 


(95) 


In  addition  to  the  geometric  constraints,  the  designer  also  specifies  the  functional  con¬ 
straints.  For  this  example  we  will  impose  the  conditions  of  the  trajectory  of  point  3 

passing  as  close  as  possible  to  a  finite  set  of  design  points  (Pi,  P2,  P3 . Pn),  as  shown 

in  figure  16. 

It  is  clear  that  each  design  point  corresponds  to  a  different  value  of  the  dependent 
coordinates  vector  q.  We  will  call  these  values  (q*,  q^,  ...,  q^).  Now  the  functional 
constraints  are  imposed  for  each  design  point.  For  instance,  for  a  generic  point  (i) 


xi-xp.  =  0 


(96) 
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yi-yp.  =  0 


(97) 


where  i*  1,2,  ...,N. 

In  the  general  case,  if  q  and  b  are  the  vectors  of  dependent  coordinates  and  design 
variables,  the  geometric  constraints  equations  can  be  expressed  in  vector  form  as 


®(q,  b)  =  0  (98) 

It  may  be  seen  that,  using  natural  coordinates,  the  constraints  equations  are  very  sim¬ 
ple  and  the  design  variables  b  appear  explicitly  in  O.  The  constraint  eqs.  (98)  differ  from 
the  ones  considered  in  previous  Sections  in  the  fact  that  the  parameters  in  b  are  not  con¬ 
stant  as  before,  but  true  variables,  because  we  are  trying  to  finding  their  optimum  values. 

The  whole  set  of  constraints  for  the  design  point  (i)  -geometric  and  functional-  can  be 
written  as 


«b'(q‘,  b)  =  0  i  =  l,2,...,N  (99) 

Let  us  now  introduce  the  objective  function.  We  would  like  that  point  3  of  our  ^our  bar 
example  goes  exactly  through  the  design  points  Pj.  If  it  is  not  possible,  we  would  like  to 
get  a  four  bar  mechanism  whose  dimensions  guarantee  that  the  error  in  getting  these 
design  points  is  minimum  in  some  sense.  In  other  words,  since  exact  solutions  for  the 
design  problem  may  not  exist,  we  will  look  for  the  optimal  solution  in  the  least  square 
sense.  Let  us  define  an  objective  function  of  the  form 

N  _ 

T(q>,  q2,  ...,  qN.b)  =  ^  £  O'  (q‘.  b)  0‘(qi,  b)  (100) 

^  i=i 

or  in  a  more  compact  form 

m  b)  =  iO(q,b)^*(q,b)  (101) 
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where  q  is  the  vector  q^  =  { q^"^,  q^^, q*^)  and  O  is  a  vector  that  contains  all  the  ge¬ 
ometrical  and  functional  constraints.-  The  optimum  design  problem  consists  in  minimiz¬ 
ing  the  objective  function  4'  with  respect  to  vectors  q  and  b,  that  is 

min4'(q,b)  =  ^<b(q,b/<I>(q,b)  (102) 

q,b  I 

Differentiating  with  respect  to  q  and  b,  and  equating  to  zero,  the  following  system  of 
non  linear  equations  is  obtained 

J(q,  b)  C>(q,  b)  =  0  (103) 

where 


J(q,  b)  = 


SO(q,b) 


3<P(q.  b) 


db 


(104) 


_We  may  now  solve  the  nonlinear  cqs.  (103)  by  a  quasi-Newton  method.  Expanding 
<l>(q,  b)  in  Taylor’s  series 

A  q.  b  +  A b)  =  0(q,  b)  +  +  •  •  ■  (105) 

lAb ) 

and  substituting  in  eq.  (103),  we  obtain 


J(q.b)<l>(q,b)  +  J(q,b)r(q,b) 


=  0 


from  which  the  following  iterative  expression  can  be  obtained 

1  b  Li  "  ( b  L 


(106) 


(107) 


This  method  is  sufficiently  simple  and  general  to  be  applied  to  nearly  any  system 
topology  (planar  and  three  dimensional,  open  and  closed  chains,  with  any  number  and 
kind  of  Joints  and  bodies),  and  can  accommodate  any  kind  of  functional  constraints,  even 
a  mixed  set. 

We  will  find  now  the  complete  set  of  constraint  equations  for  the  four-bar  mechanism, 
considering  five  design  points.  Panicularizing  equations  (91)-(95)  and  (96)-<97)  for  the 
generic  design  point  Pj 

(xi-XA)^  +  (yi-yA)^-d?A  =  0  (108) 

(x\-xi)^-H(y}-yi)^-d?2=0  (109) 

(xi  -  xb)^  +  (yi  -  vb?  -  =  0  (110) 


-  (1  +  x3/di2)  xj  +  (ys/du)  y{  +  (x3/di2)  xj  -  (y3/di2)  yi  +  xi  =  0  (ill) 


-  (y^djj)  xj  -  (1  +  x3/d,2)  y|  +  (y3/di2)  xi  +  (Vdj2)  yi  +  yi  =  0  (112) 
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4-xp,  =  o 


(113) 


yi-yPi=o  (114) 

for  i  =  1,2 . 5.  There  are  then  35  constraint  equations.  The  number  of  unknowns  is 

also  35:  five  values  of  the  6-element  dependent  coordinates  vector  q‘  plus  the  five 
elements  of  the  design  variables  vector  b.  Then,  with  five  design  points  it  is  possible  to 
get  a  mechanism  that  exactly  satisfies  the  functional  constraints.  If  we  have  more  than 
Hve  design  points,  we  only  can  get  an  optimal  solunon  in  the  least  square  sense. 


Figure  17.  Complex  multibody  system  with  flexible  bodies. 


1 


I 


i 


6.  Numerical  Example 

Figure  17  shows  a  complex  system  consisting  of  a  6R  spatial  manipulator  with  two  i 

flexible  links  mounted  on  a  clamped  flexible  plate.  The  manipulator’s  end-effector  is 
grasping  a  lumped  mass  of  100  Kg.  This  example  combines  the  three  formulations  with  ; 

natural  coordinates  previously  described.  The  plate  has  been  modeled  with  3  static  and  6  ; 

dynamic  modes  obtained  from  a  finite  element  discretization  of  1 6  elements.  Each  one  of  :  * 

the  two  slender  bodies  have  been  modeled  with  4  nonlinear  beam  elements.  '  ; 

This  manipulator  undergoes  a  motion  given  by  the  following  law:  r  '  > 

<P(t)  =  ‘Po  +  ^(2Jt:^-sin(2rt;l;))  OStST  ;  i 

2ji\  T  ^  VI  (115)  I  i 

(p(t)  =  0  TStS20scc  i  I 

where  T  =  15  s  and  the  angle  increments  for  each  joint  are:  A(pi=  1.650  rad,  A(p2=  2.102  I  | 

rad,  A<P3= -1.200  rad,  A(p4=  0.698  rad,  A(p5*0.0rad  and  Aipg®  0.0  rad.  |  | 

To  evaluate  the  deviation  of  the  manipulator’s  tip,  the  same  motion  law  has  been  I  | 

imposed  to  a  rigid  model  of  the  manipulator  and  plate.  The  difference  between  the  rigid  |  ” 
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Figure  18.  Difference  between  rigid  and  flexible  tip’s  trajectories. 

trajectory  and  the  flexible  one  is  illustrated  in  Figure  18.  It  can  be  seen  that  after  the 
input  motion  stops,  at  t  =  IS  s,  a  fl-ee  oscillation  of  constant  amplitude  remains. 
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ABSTRACT  :  The  paper  detctibee  a  finite  element  formulation  of  flexible  multibody  sys¬ 
tems.  The  discretized  equations  of  motion  are  formulated  using  the  augmented  lagrangian 
approach  and  are  solved  in  an  implicit  manner.  Symbolic  computation  is  utilized  to  develop 
the  element  models.  Flexible  membere  are  treated  in  two  ways:  either  in  a  fully  nonlinear 
manner  using  a  geometrically  exact  beam  model,  or  through  the  substructuring  concept. 
Two  complex  joint  models  are  presented:  a  cam  pair  with  double  curvature  and  a  flexible 
sUder.  Dry  friction  effects  are  taken  into  account  using  a  regularizaticn  procedure. 


1.  Introduction 

The  computer  approach  to  flexible  multibody  systems  presented  in  this  survey  paper  results 
from  a  research  project  started  at  the  Aerospace  Laboratory  (LTAS)  of  the  University  of 
Liege  since  1984  under  the  direction  of  the  first  author.  It  has  significantly  progressed  from 
1986  to  1989  thanks  to  the  contribution  of  A.  CARDONA  who  prepared  and  presented  his 
PhD  thesis  [1]  on  the  subject  at  the  University  of  Libge  in  1989.  The  resulting  software 
(MECANO,  a  specific  module  of  the  general  finite  element  software  SAMCEF)  has  now 
become  an  industrial  product  but  its  development  still  remains  a  subject  of  intense  industrial 
research  at  LTAS.  The  other  two  co-authors  are  members  of  the  LTAS  research  team  who 
have  later  contributed  to  the  project  on  specific  aspects  such  as  joint  modelling  [5]  and 
automatic  software  generation  through  symbolic  computation  [11]. 

Our  objective  has  been  to  generalize  the  concept  of  finite  element  to  articulated 
systems,  starting  from  the  methodology  adopted  in  nonlinear  structural  dynamics  codes 
based  on  implicit  time  integration. 

Indeed,  the  evaluation  of  the  existing  mechanism  analysis  softwares  which  were  avail¬ 
able  commercially  when  this  project  was  started  and  which  still  are  on  the  market  today 


325 


revealed  that  most  of  them  have  been  designed  for  systems  made  of  rigid  bodies  and  there¬ 
fore  do  not  perform  efficiently  when  flexibility  effects  in  the  members  have  :j  be  taken  into 
account. 

The  finite  element  approach  to  flexible  multibody  systems  may  be  regarded  as  a 
particular  case  of  the  cartuian  coordinate  approach.  An  essential  difference,  however, 
remains  in  the  manner  in  which  the  kinematics  of  flexible  motion  is  described.  When 
dealing  with  flexible  bodies,  it  is  usual  to  assume  that  global  motion  is  decomposed  into  a 
ripd-body  motion  to  which  is  superimposed  a  small  deformation.  The  main  limitation  of 
this  decomposition  is  that  linear  elasticity  is  necessarily  assumed  in  the  rigid  body  frame 
and  therefore  important  nonlinear  effects  such  as  geometric  stiffening  may  be  mijsed  in  the 
resulting  analysis. 

The  finite  element  methodology  described  here  repres>mts  a  full  departure  from  tradi¬ 
tional  approaches  in  the  sense  that  the  total  motion  (including  thus  rigid  body  motion  and 
elastic  deformation)  is  directly  referred  to  the  inertial  frame. 

The  following  advantages  result  from  this  assumpt’jn: 


•  The  representation  of  Inertia  forces  is  greatly  simplified; 

-  the  stiffness  properties  of  each  elastic  member  may  be  described  in  a  quite  rigorous 
manner,  induding  the  geometric  stiffening  effects. 

The  general  prindples  of  this  finite  dement  approach  are  described  in  section  2.  Start¬ 
ing  froru  an  adequate  parametrization  of  finite  rotations  and  displacements  we  compute, 
according  to  figure  1.1,  appropriate  measures  of  strain  and  rdative  motion  in  terms  of 
which  the  structural  matrices  of  the  dements  are  devdoped.  They  are  built  from  the  aug¬ 
mented  lagrangiaii  despiption  of  the  constraints,  assumed  holonomic  at  this  stage  for  sake 
of  simplidty. 


Due  to  the  stiff  character  of  the  motion  equations  obtained  in  differential-algebraic  '• 

form  after  discretization,  the  method  of  solution  adopted  is  of  implidt  type  (based  on 
Newton-Baphson  iteration)  and  therefore  the  motion  equations  have  to  be  devdoped  in  * 

linearized  form.  Elffident  time  integration  is  deult  with  separatdy  in  a  companion  paper  i 

[10]-.  : 

I 

The  concept  of  finite  dement  has  been  iq>plied  up  to  now  to  devdop  a  quite  extensive  | 

library  of  rigid  and  flexible  joint  smd  member  dements  which  cannot  aU  be  described  in  I 

the  present  contribution.  Section  3  deals  with  flexibility  effects  in  the  members  and  is  itself  I 

divided  into  two  main  parts:  subsection  3.1  presents  the  formalism  adopted  to  devdop  a  3-D  t 

dastic  beam  dement,  while  subsection  3.2  deals  with  the  spedfic  problem  of  substructuring,  f 


the  objective  bdng  to  modd  the  structural  behavior  of  flexible  components  of  arbitrary 
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figure  1.1  :  Principle  of  the  finite  element  approach  to  multibody  systems. 


shape  starting  from  a  component  mode  representation  obtained  standard  dynamic  linear 
analysis.  Section  4  is  devoted  to  the  finite  element  description  of  joints,  and  starts  with 
the  extension  to  non-holonomic  constraints  of  the  concepts  presented  in  section  2.  The 
very  simple  case  of  a  hinge  joint  is  treated  next  in  order  to  show  that  automatic  element 
generation  can  be  performed  through  symbolic  computation.  Finally,  subsections  4.3  and 
4.4  present  two  joints  of  very  complex  nature:  a  cam  pair  with  double  curvature  and  a 
flexible  slider  element.  In  both  cases,  dry  friction  is  taken  into  account  using  a  regularization 
procedure.  ^ 


Section  6  describes  three  applications  which  demonstrate  the  validity  of  the  concepts 
presented. 

2.  General  Concepts 


2.1.  FINITE  ROTATION  DESCRIPTION 

Numerous  techniques  exist  to  represent  a  finite  rotation  in  space  which  have  each  their 
respective  advantages  and  drawbacks.  The  main  criteria  to  be  considered  for  selecting  an 


.  £' 
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appropriate  formalism  are  [2]  the  number  of  parameters  involved  (3  or  4),  their  physical 
meaning,  their  algebraic  properties,  the  existence  of  singularities  and  the  form  taken  by  the 
associated  composition  law  for  successive  rotations. 

According  to  these  criteria,  the  system  of  parameters  that  we  have  selected  is  the  set 
of  3  parameters  formed  by  the  cartesian  components  of  the  rotation  vector 


9  =  n9  (2.1.1) 

where  n  represents  the  instantaneous  rotation  axis,  and  $  is  the  rotation  amplitude  about 
it. 

Let  us  recall  that  the  exponential  form 

R  =  1  +  »  +  +  •••  =  exp(«)  (2.1.2) 

allows  constructing  the  rotation  operator  R  in  terms  of  the  vector  (2.1.1),  where  ^  is  the 
skew-symmetric  matrix  made  of  the  components  of  4'  (^fy  =  — .  If  one  denotes 
by  @  the  material  rotation  increment,  i.e.  expressed  in  a  referential  frame  attached  to  the 
moving  and/or  deforming  body,  the  incremental  rotation  is  then  expressed  by  the  mutrix 

dR  =  Rd©  (2.1.3) 


and  the  material  rotation  inaements  are  thenuelves  related  to  the  finite  rotation  parameters 
by  a  linear  relationship  of  type 


d©  =  T(’*')  S9 

with  the  matrix  T(^')  pven  by  [2] 


T(«')  = 


sjnWI,  , 
ll«ll 


sin||»|h  T.UfiBjW 
||»ll  )  l|'f||/2 


(2.1.4) 


(2.1.5) 


Equation  (2.1.4),  which  forms  the  basis  of  the  adopted  formalism,  allows  computing  the 
angular  velodties  with  a  similar  relationship.  Their  time  derivative  provides  also  the 
expression  of  angular  accelerations 


n  =  TC*')  9 
A  =  T{«')’i'  +  T(«)4' 


(2.1.6) 


The  elements  of  the  cartesian  rotation  vector  allow  to  represent  rotations  of  any  mag¬ 
nitude.  However,  equation  (2.1.5)  shows  that  matrix  T('9')  becomes  singular  when 
ll’J'll  -f  (2kr,  k  =  1,2,...)  and  therefore  the  parametrizatiosi  presents  differentiability 
holes.  This  inconvenience  can  be  overcome  by  restricting  the  rotation  vector  to  the  range 


I 


Whenever  the  rotation  violates  condition  (2.1.7),  the  rotational  vector  is  modified  according  | 

to  (3)  i 

It  is  easy  to  verify  that  4**  verifies  the  conditions  ; 

f 

R(4')  =  R(«'*)  and  ||'5'*!|  <  (2.1.9) 


2.2.  THE  CONCEPT  OF  FINITE  ELEMENT  IN  MULTIBODY  DYNAMICS 


i 


I 


The  concept  of  finite  element  model  may  be  adopted  in  a  most  general  sense  to  represent  any 
type  of  functionality  appearing  in  the  description  of  a  mnltibody  system  :  rigid  or  elastic 
member,  mechanical  joint,  mechanism  of  interaction  either  between  members  or  between  a 
member  and  the  external  world. 


In  all  cases,  adequate  kinematic  description  and  parametrization  of  finite  motion  allows 
to  define  appropriate  measnres  of  deformation.  Hl^d  elements  are  tbim  characterized  by 
the  condition  of  zero  deformation,  while  flexible  elements  are  derived  from  a  virtual  work 
expression  and  the  assumption  of  a  constitutive  law.  This  very  general  reasoning  allows  to 
construct  a  finite  element  library  specialized  to  mnltibody  analysis  in  terms  of  which  most 
mechanical  interactions  may  easily  be  described.  The  element  library  available  in  MECANO 
[4]  includes  rigid  and  elastic  bodies,  different  types  of  li^d  and  deformable  joints,  active 
elements,  element  describing  various  interaction  modes  such  as  dissipation  ;  it  also  allows 
to  customize  the  library  through  the  concept  of  user  element. 


The  global  description  of  the  finite  element  model  of  any  multibody  system  can  be 
made  using  the  following  definitions  and  notations  :  ' 

-  q  is  a  globcl  set  of  degrees  of  freedom  (DOF)  describing  the  absolute  positions  and  t 

orientations  of  the  representative  points  of  the  system  ;  i 

i 


-  q,  denotes  the  DOF  set  of  a  ^ven  element,  and  Le  is  a  boolean  operator  such  that  the 
relationship  between  elemental  and  global  DOF 


q,  =  I<eq  (2.2.1) 

implidtly  contains  the  topolo^cal  description  of  the  system. 

The  kinematic  constraints  may  express  joint  constraints,  behavior  restrictions  or  driv¬ 
ing  constraints.  They  are  always  defined  at  the  element  level  and  take  the  most  general 
(nonholonomic,  rheonomic)  form 

♦(qe.^.0  =  0  (2.2.2) 
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They  are  introduced  through  the  definition  of  a  set  X  of  lagrangian  multipliers. 

i:.<tch  element  is  also  characterized  by  its  strain  and  kinetic  energies,  so  that  the  total 
internal  energy  of  the  system  and  its  kinetic  energy  are  computed  through  summation  on 
individual  elements 


Wint  =  53  ^  =  53  fle.  0 


(2.2.3) 


Likewise,  the  global  dissipation  forces  result  from  elemental  contributions  to  the  virtual 
work  of  friction  forces 

SWfr  =  53  Lj  d/r..(q.,  iu)Sq,  (2.2.4) 

e 

Finally,  the  external  virtual  work  is  directly  written  in  terms  of  the  external  forces  them¬ 
selves 

«>V*.,  =  -g„,(q,q,0«q  (2.2.5) 


The  system  equations  of  motion  are  deduced  from  the  variational  equation 


S  /**(JC->v-A^*)*  =  o 

Jti 


(2.2.6) 


where  SW  -  d>V,„,  +  eWtn- 


In  the  holonomic  case  (the  non-holonomic  case  will  be  considered  in  section  4.1),  they 
take  the  form  of  the  system  of  differential-  algebrsic  equations  (DAE) 


Mq-bB^A  =  g(q,q,f) 


jMq-bB^ 
l*(q,t)  = 


(2.2.7) 


where  M  is  a  symmetric,  positive  definite  mass  matrix  obtained  from  the  assembling  of  the 
element  contributions  ;  it  is  generally  configuration-dependent ;  the  term  Mq  contains  the 
relative  inertia  forces ;  g(q,q,f)  is  the  sum  of  internal,  external  and  complementary  inertia 
forces  ;  B  =  is  the  gradient  matrix  of  the  kinematic  construnts. 

Let  us  finally  mention  that  the  nnmerical  conditioning  of  equation  system  (2.2.7)  may 
be  significantly  improved  in  view  of  its  numerical  solution  by  making  use  of  the  augmented 
lagranpan  method  [5].  It  consists  of  adding  to  the  variational  equation  (2.2.6)  a  penalty 
term  in  the  constrsdnts  which  reinforces  the  positive  definite  character  of  the  functional. 
The  modified  functional  takes  the  form 


S  [K-yV-  - P**^)(fr  =  0 

Jtl 


(2.2.8) 


where  ^  is  a  scaling  factor  on  the  constraints  and  p  is  a  penalty  term.  The  modified 
equations  of  motion  are  then 


f  Mq  +  B^(A;A  +  pi)  =  g(q,  q,  t) 
\ki{q,t)  =  Q 


(2.2.9) 


The  soiution  of  (2.2.9)  obviously  coincides  with  that  of  (2.2.7)  since  the  term  involving  the 
constraints  vanishes  when  the  latter  are  verified. 


2.3.  IMPLICIT  METHOD  OF  SOLUTION 

The  choice  of  an  implicit  method  of  solution  allows  to  imbed  any  kind  of  analysis  in 
the  same  formalism.  In  particular,  the  kinematic  analysis  of  the  system  results  from  the 
determination  of  a  succession  of  configurations  with  zero  strain  energy  and  a  quasi-static 
analysis  corresponds  to  the  succession  of  equilibrium  configurations  obtained  by  omitting 
the  kinetic  energy  of  the  system. 

2.S,1  Linearuation  of  Motion  Equations.  The  implicit  solution  of  the  dynamic  case  relies 
upon  linearization  of  the  DAE  equations  (2.2.9)  and  proceeds  as  follows.  Let  us  assume  that 
(q*)  q*.  q*t  A*)  represents  an  approximate  solution  of  system  (2.2.9)  at  time  t.  A  corrected 
solution  is  obtained  in  the  form 


(q*  -f-  Aq,  q*  +  Aq,  q*  -I-  Aq,  A*  -1-  A  A) 

from  the  solution  of  the  inaemental  equations 

f  MAq  -I-  C*Aq  +  S‘Aq  -t-  kB’^AA  =  r*  -1-  0(A*) 
\ifeBAq=~**’’  +  0(A*) 


(2.3.1) 


(2.3.2) 


where  r  is  the  residual  vector  of  dynamic  equilibrium 

r  =  g(q,q,0-Mq-B^(kA+p^^)  (2.3.3) 

and  where  the  tangent  stiffness  and  damping  matrices  S*  and  C*  are  computed  ffom 

=  <='  =  -51  (2") 


fS 


2.3.2  Time  Integration.  Time  integration  of  the  second-order  DAE  equations  (2.3.2)  is 
performed  using  an  integration  scheme  of  Newmark  type  (6).  The  motivations  of  this  choice 


are 
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-  the  filtering  of  high  frequencies  brought  into  the  model  by  elasticity,  s 

I 

-  the  low  dependence  of  algorithm  stability  with  time  step  size,  i 

•  the  software  simplification  brought  by  one-step,  second-order  time  integration,  i 

I 

-  the  use  of  existing  software  architecture  for  structural  dynamics,  f 

-  the  accumulated  experience  in  implicit  nonlinear  structural  dynamics  with  Newmark 

type  methods.  \ 

I 

Newmark’s  integration  scheme  consists  of  a  simultaneous  interpolation  of  displacements 
and  velocities,  implicit  in  accelerations 


qn+t  =  qn  +  (1  -  7)fcqn  +  +7/»qn+l  +  e'n 

qn+1  =  q*!  +  ^qn  +  (2  "  +  +^^^qn-H  +  «n 

with  the  local  truncation  error  on  displacements  [7] 


en  =  ()3  -  (2.3.6) 

The  constants  (0,  7)  coeffidents  are  integration  parameters.  The  values 

/?  =  !  and  7=5  (2.3.7) 

provide  unconditionr’  stability  with  maximum  accuracy  for  a  linear  system. 

It  can  be  shown  [8,26]  that  the  straightforward  application  of  Newmark’s  method  with 
the  parameters  (2.3.7)  to  the  DAE  system  (2.3.2)  leads  to  a  weak  instability  of  the  method 
induced  by  the  algebraic  constraints.  This  instability  can  be  controlled  by  adapting  the  , 

asymptotic  behavior  of  the  algorithm.  A  detuled  discussion  of  the  numerical  aspects  (i.e.  j 

stability,  accuracy,  time-step  control)  assodated  to  time  integration  of  equations  (2.3.2)  ; 

using  Newmark  type  methods  is  made  in  [9-10).  '  > 

I 

2.S.S  Effective  incremental  procedure,  Spedal  care  has  to  be  taken  in  the  increnentation 

procedure  of  the  rotational  DOF  since  finite  rotations  are  not  additive  quantities.  ] 


Let  us  split  the  set  of  kinematic  unknowns  into  translation  and  rotation  parameters 
(q^  A’’]  =>  [d’'  9^  A^j  (2.3.8) 


Displacements  and  lagrangian  multipliers  are  incremented  in  the  usual  manner 
d(t)  =  dn  -h  Ad  A(t)  =  An  +  AA 
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where  the  displacement  and  lagran^an  multiplier  inciemmts  are  solutions  of  the  tangent 
linear  system 

rs‘  +  :^C‘  +  ^M  fcBnrAql_r  r 
[  ifcB  0  J  [aAJ  (2.3.16) 

Corrected  values  for  Rn+i>  n„+i,  A„+i  are  computed  from 
—  R>nR'(®«ne,n+l) 

f^n+l  “  T(4'jne,n+l)^«nc,n+l  (2.3.17) 

Afi+l  =  T('?ine,n+l)®«ne,n+l  +  T(®«ne,n+l)'j'«ne,n+l 

Iteration  is  pursued  until  the  system  reaches  equilibrium  state,  which  is  characterized  by 
the  vanishing  of  the  virtual  work  repressions 

Sq^t  =  0  and  =  0  (2.3.18) 

In  practice,  eqns  (2.3.18)  are  considered  to  be  satisfied  whenever  the  inequalities 

||r||<<  and  ||4^1|  <  q  (2.3.19) 

are  satisfied  with  given  tolerances  e  and  q. 


2.4.  GENERATION  OF  FE  MODELS  THROUGH  SYMBOLIC  COMPUTATION 


The  computation  by  hand  of  the  rather  complex  mathematical  expressions  resulting  from 
the  present  FE  formulation  has  several  drawbacks,  namely 

•  the  long  and  sometimes  tedio...  programming  phase  (checking,  validation...); 

•  the  obtention  of  a  Fortran  source  code  which  is  not  necessarily  optimized. 

Besides,  this  complexity  can  represent  a  real  obstacle  to  the  development  of  more  elaborate 
elements. 

An  alternate  approach  for  developing  such  a  code  consists  in  using  computer  algebra 
in  a  first  step  to  generate  automatically  and  to  simplify  all  the  cumbersome  mathematical 
expressions  that  have  to  be  evaluated  [11].  The  main  advantages  of  this  approach  are  : 

-  the  obtention  of  a  more  reliable  generated  software  (automatic  generation  of  the 
mathematical  expressions  nummizes  the  risk  of  errors); 

•  the  possibiUty  to  simplify  the  symbolic  expressions  generated  through  computer  algebra 
system  and  thus,  to  mininuze  the  number  of  arithmetic  operations  before  generating 
an  optimized  Fortran  source  code; 

-  the  increased  fadllty  to  extend  the  capabilities  of  the  software  through  automatic  gen¬ 
eration  of  new  elements  of  which  the  manual  development  would  be  too  combersome; 


-  a  better  efficiency  of  the  developer  who  is  relieved  from  performing  complex  algebrtiic 
developments. 

A  symbolic  program  has  been  developed  upstream  from  the  MECANO  software  [12]  in 
order  to  automatically  develop  the  FE  models.  The  computer  algebra  system  under  which 
this  symbolic  macro-procedure  is  written  is  MAPLE  [13]:  it  has  been  selected  mainly  for 
the  power  of  its  built-in  programming  tools  (linear  algebra  package,  differentiation  facility, 
advanced  programming  language...). 

This  symbolic  macro-procedure  is  divided  into  3  mains  parts: 

-  the  symbolic  treatment  of  the  finite  rotations; 

-  the  symbolic  computation  of  basic  expressions  such  as  kinetic  and  potential  energies, 
virtual  work  and  kinematic  constraints; 

-  the  automatic  derivation  of  the  tangent  FE  iteration  matrices  (mass,  stiffness,  gyro¬ 
scopic  and  damping  matrices). 

Figure  2.4.1  sumiaaiizes  the  succesive  steps  of  the  procedure. 

2.4.1  Symbolic  treatment  of  the  finite  rotatione.  It  consists  essentially  in  the  obtention  of 
the  symbolic  forms  of  the  rotation  operator,  the  natrix  T('i')  and  the  angular  velocities 
and  accelerations  in  terms  of  the  rotation  parameters  (2.1.1). 

2.4.2  Billy  automatic  derivation  of  the  tangent  FE  matrices.  In  order  to  describe  the  ca¬ 
pabilities  of  that  part  of  the  symbolic  program,  the  development  of  a  rigid  body  element  is 
briefly  decribed. 

Starting  from  the  symbolic  expression  of  the  kinetic  energy,  the  procedure  automati¬ 
cally  computes  the  symbolic  expressions  of  the  material  inertia  forces,  the  mass  matrix,  the 
centrifugal  stiffness  matrix  and  the  gyroscopic  matrix. 

The  complete  tangent  FE  iteration  matrices  obtained  in  this  way  are  directly  written 
in  terms  of  generalized  coordinates. 

Figure  2.4.2  presents  the  symbolic  expression  obtained  for  the  rotational  part  of  the 
mass  matrix.  Matrix  Mr  is  in  fact  the  matrix  product  JT  where  T  is  the  linear  operator 
(2.1.5)  and  J  is  the  inertia  tensor  of  the  body,  assumed  here  diagonal  for  sake  of  simplicity: 

J  =  diag{Jii  Jit  J33)  (2.4.1) 

2.4.3  Symbolic  treatment  of  the  kinematic  constraints.  The  constraints  expressing  the  in- 
deformability  of  the  rigid  body  element  are  treated  by  the  Lagrange  multiplier  technique. 
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Figure  24-1  •'  Generation  of  a  flexible  muUibody  dynamics  software 
throught  symbolic  programming 


Their  contribution  to  the  FE  iteration  matrix  implies  the  evaluation  of  the  Jacobian  matrix 
of  the  constraints  B  and  of  their  second  derivatives  (cf.  2.3.4).  The  latter  evalu.~tion  can 
be  very  tedious  when  manually  completed.  It  is  not  essential  for  computing  a  transient 
response  but  it  can  be  shown  to  be  essential  for  stability  analysis. 


A  significant  part  of  the  symbolic  procedure  is  devoted  to  the  treatment  of  these  kine¬ 
matic  constraints.  Starting  from  thdr  symbolic  expression  (written  in  vectorial  form), 
the  symbolic  procedure  automatically  computes  the  first  derivative  of  the  kinematic  con¬ 
straints,  the  symbolic  expression  of  the  Jacobian  matrix  B  (the  result  being  directly  written 
in  terms  of  the  nodal  parameters),  the  symbolic  expression  of  the  second  derivatives  and 
their  contribution  (in  term  of  the  nodal  parameters)  to  the  Hessian  matrix  (2.3.4). 

The  capabilities  of  this  part  of  the  symbolic  procedure  devoted  to  the  treatment  of  the 
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Figure  2.4.2  :  Automatic  derivation  of  the  tangent  FB  matrices. 


kinematic  constraints  are  illustrated  in  section  4.2  where  the  symbolic  generation  of  a  hinge 
joint  element  is  presented. 


3.  Finite  Element  Representation  of  Elastic  Components 


3.1.  BEAM  R’ .PRESENTATION  OF  ELASTIC  MEMBERS 

The  appropriate  description  of  flexible  members  requires  in  many  cases  the  use  of  a 
formalism  which  incorporates  properly  the  geometric  nonlinear  effects  such  as  geometric 
stiffening.  It  is  therefore  essential  to  rely  upon  a  true  nonlinear  beam  theory  [3,14-16]. 

3.1.1  Kinematie  kypothetet.  The  behavior  hypotheses  adopted  are  the  following: 

(i)  the  beam  is  rectilinear, 

(ii)  the  beam  rioss  sections  remain  plane  after  deformation, 

(iii)  the  shear  deformation  is  allowed, 

(iv)  the  rotational  kinetic  energy  of  crou  sections  is  taken  into  account. 

The  kinematic  assumptions  (i)  and  (ii)  can  be  summarised  by  the  following  equation 

x  =  xo  +  X.t.,  0*2,3  (3.1.1) 

where  xo(t)  represents  the  position  of  the  beam  neutral  axis  in  the  global  reference  frame 
and  Xa  (a  s  1,2)  are  the  material  coordinates  of  a  point  on  the  ctou  section  (figure 
3.1.1).  The  base  vectors  ta  are  attached  to  the  beam  cross  section  and  therefore,  give  the 
instantaneous  orientation  of  the  material  frame  R.  The  current  orientation  of  the  base 
vectors  it  calculated  in  terms  of  the  current  rotation  operator  R(s) 

t^  =  RE,-  (i  =  1,2,3)  (3.1.2) 


3.1.2  .Material  .Measures  of  Beam  Deformation.  The  measures  of  beam  deformation  are 
obtained  from  the  comparison  of  displacement  gradients  in  reference  and  current  configu¬ 
rations. 

The  displacement  gradients  in  reference  coniiguiation  are  computed  from  the  reference 
position  of  a  material  point 

^  =  sEi  4-  XjEa  +  X3E3  —  •^  =  El  (3.1.3) 


The  displacement  gradients  in  the  deformed  configuration  are  obtained  through  derivation 
of  (3.1.1) 

dx  _  dxo  .  „  dtj  dt3 

d..  ds  dj  ds 

with  the  base  vector  variations  along  the  beam  axis 

df  =  d7®^  =  dT^  (3.1.5) 

Substituting  then  (3.1.5)  into  (3.1.4)  provides  the  relationship 

S  =  T  +  *•>) 

which  expresses  the  positio .  gradients  in  spatial  coordinates.  The  substraction  of  (3.1.3) 
from  (3.1.6)  after  expressing  both  quantities  in  the  material  frame  provides  the  material 
measure  of  beam  deformation 

E(s,X)  =  R^(^  -  t,)  -I-  R^~(X,E,  -H  X3E3)  (3.1.7) 

The  first  term  involves  the  material  measure  of  centroidal  line,  or  axial  strain 

^  (3-1-8) 

Its  components  may  be  interpreted  as  follows:  Ft  is  the  extensional  strain,  and  (Fi,  Fs) 
are  the  shear  strains  along  axes  tj  and  ts. 


The  second  term  involves  the  material  measure  of  curvature 

K  = 

ds 


(3.1.9) 


Ki  is  the  torsional  deformation,  while  K2  and  K3  are  the  bending  curvatures  along  axes  tj 
and  t3.  The  variations  of  the  deformation  measures  (3.1.8)  and  (3.1.9)  are  given  respectively 
hy  _ 

^r_RT^(^^^RT^j^0  6K  =  ^  +  K5Q  (3.1.10) 


b  view  of  expressing  dynamic  equilibrium,  they  can  also  be  put  in  the  inverse  forms 

^(5xo)  =  lUr  -  and  ^(56)  =  RJK  (3.1.11) 

wb?;e  S0  =:  Ri@  is  the  spatial  rotation  increment. 


3.1.3  Local  Expression  of  Dynamic  Equilibrium.  The  stresses  acting  on  the  beam  cross 
section  are  evaluated  in  terms  of  the  Lagrange  stress  vectorfT  defined  as  the  stress  resultant 
per  unit  of  undefonned  cross  section  (iiguie  3.1.2).  The  latter  is  resolved  along  the  base 
vectors  attached  to  the  cross  section 


<r  =  ffiiti  +  ffijta  +  (Tijts 


(3.1.12) 


Internal  equilibrium  is  then  expressed  in  terms  of  the  following  quantities:  b  the  external 
force  per  unit  of  volume  b,  the  specific  mass  po<  tLe  rotary  inertia  tensor  of  the  cross  setion 
expressed  in  spatial  coordinates  I,  the  spatial  angular  velocities  and  accelerations  a  and  u>. 
Expressing  translational  equilibrium  of  a  beam  element  of  length  ds  provides  the  equation 
integrated  over  the  cross  section 

+  b  —  pox]ds  =  0  (3.1.13) 

Similarly,  rotational  equilibrium  can  be  expressed  in  the  form 


J  l^^tr  +  (x  -  xo)x^]ds  =  Ia+u;xL>  -  j  i*  ~  xo)  x  bds  (3.1.14) 

The  dynamic  equilibrium  equations  (3.1.13)  and  (3.1.14)  can  be  expressed  in  term*  of  stress 
resultants  obtained  through  integration  over  the  cross  section 


da 

ds 


-11+  uxo 


dm  dxo  ,  ,  _ 

-7-  +  ~  xn=rla  +  u;xlu;-15 
ds  ds 


(3.1.15) 


where  fi  denotes  the  mass  per  unit  length.  The  spatial  measures  of  beam  stress  resultants 
and  loads  are  defined  by 

n  =  fg  <rdS  =  the  contact  force  on  the  cross  section 

™  ~  /s(^  ~  xo)  X  (rd5  =  the  moment  of  stresses  on  the  cross  section 

n  =  fg  bdS  =  the  external  force  on  the  cross  section 

^  ~  fs(^  ~  ^  ~  external  moment  on  the  cross  section 


! 


and 


with 


iWir 


=  j  [(fx^(/<3^)  +  (^©^(JA  +  nx  Jn)]d5  (3.1.25) 


J  =  R^IR 


(3.1.26) 


I 

( 

! 

i 
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3.1.5  ConstiMive  Equations.  The  material  is  assumed  linear  elastic,  so  that  the  internal  ) 

stress  resultants  are  related  linearly  to  beam  strain  measures 

! 

E  =  CE  (3.1.27) 

with  the  diagonal  matrix  of  elastic  coefficients 

C  =  diag(EA,GA‘i,GA3,GJ,  EIj,  Eli)  (3.1.28) 

EA  is  the  axial  stiffness,  GJ  is  the  torsional  stiffness,  and  (GAj,  GAi)  and  (£/],  Eh) 
denote  respectively  the  shear  and  bending  stiffnesses  along  transverse  axes. 


S.1.6  Finite  Element  Discretization.  The  iinite  element  discretization  of  the  virtual  work 
expressions  (3.1.22)  is  a  lenghty  process  which  we  will  only  summarize  here.  A  full  derivation 
of  the  beam  element  together  with  numerical  comparisons  can  be  found  in  [3]. 

The  discretization  of  eqns  (3.1.22)  is  based  on  a  linear  interpolation  of  both  displace¬ 
ments  and  rotation  parameters 


xo(s)  =  iVj(s)xo,-  4'(s)  =  Ni{s)^i  (3.1.29) 


where  xoi,  are  the  nodal  values  of  position  ud  rotation  parameters,  collected  in  vector 
q,  of  the  element  DOF,  Ni{s)  is  the  linear  interpolation  function  corresponding  to  node  t , 
and  summation  is  extended  to  the  two  nodes  of  the  element. 


The  strain  variations  of  element  e  can  be  expressed  in  terms  of  a  conJiguration  - 
dependent  strain  matrix  Be 

SE  =  Be  «q,  (3.1.30) 

the  strain  matrix  being  of  the  form  Be  =  [B(x)  ...B(„)]  with 


Ni'K^  iV,(R^xo')T 
.  0  iVi'T  +  1V.(KT  -f  T') 


(3.1.31) 


where  (.)'  denotes  derivation  with  respect  to  s.  The  internal  forces  are  such  that 


6Wm  = 


(3.1.32) 


342 


I.,.  /**•»* 


aad  take  thus  the  form 


= 

Jo 


(3.1.33) 


The  stiffness  matrix  of  the  beam  element  results  from  the  linearization  of  the  internal  forces 
accordine  to  eqn  (2.3.4).  It  includes  a  material  stiffness  term  and  a  geometric  stiffness  term 


s:  =  (^)^  =  (s!n..  +  s‘). 

with  ^ 

S|„.,  =  [  BfCeB.  ds  and  S‘  =  /  ^  E  ds 

JlO,L.\  J[0,L,\  0*lt 

The  inertia  forces  of  the  beam  element  likewise  result  from  the  discretization  of 


They  are  expressed  in  the  form 


giW.«  =  M.q,  +  he(q,q) 


(3.1.34) 


(3.1.35) 


(3.1.36) 


(3.1.37) 


where  the  first  term,  which  represents  the  relative  inertia  forces,  is  expressed  in  terms  of 
the  beam  mass  matrix 

(3.1.38) 


The  contribution  of  nodes  (  and  j  takes  the  form 


M„-  =  jf'Ar.(s)iV,(s)[g  °]ds 


(3.1.39) 


The  second  term  of  (3.1.37)  represents  the  contribution  of  the  centrifugal  and  complemen¬ 
tary  inertia  forces.  Its  linearization  according  to  (2.3.4)  generates  contributions  to  the 
tangent  stiffness  and  damping  matrices  of  eqn  (2.3.2). 

Let  us  finally  mention  that  the  integrals  over  the  beam  length  are  numerically  computed 
by  the  Gauss  integration  rule,  with  only  one  Gauss  point  in  order  to  avoid  shear  locking 
(17). 

3.2.  SUPERELEMENT  REPRESENTATION  OF  COMPLEX  MEMBERS  [18) 

Many  cases  occur  where  the  deformation  effects  inside  each  body  are  small  enough  to 
consider  that  its  elastic  behavior  remains  linear  in  a  local  frame.  Then,  It  may  be  said 
in  some  sense  that  the  nonlinearities  are  limited  to  joint  behavior.  This  fact  allows  the 


^  >  ,  'JC'  •'  ^  1  ^  V 
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development  of  methods  for  modeling  complex  elastic  mechanism  members  based  on  the 
linear  expansion  of  the  elastic  displacements  held  in  a  basis  of  deformation  modes  of  the 
body. 

It  is  however  important  to  stress  out  the  limitations  of  the  linearized  approach.  Situa¬ 
tions  may  be  identified  where  geometric  stiffness  effects  are  of  paramount  importance  in  at 
least  some  of  the  members  of  the  system,  in  which  case  the  linearized  approach  presented 
hereafter  remains  no  longer  valid  and  must  be  replaced  by  a  fully  nonlinear  description  of 
elastic  body  deformation. 

This  section  describes  one  implementation  of  the  component  mode  method  for  multi¬ 
body  analysis.  In  it,  we  seek  to  obtain  a  full  independence  between  the  vibration  analysis 
module  and  the  mechanism  analysis  one.  The  objective  is  to  be  able  to  use  any  existing 
linear  finite  element  code  of  structural  vibrations  analysis  to  build  the  component  mode 
model  of  the  elastic  member.  In  this  way,  we  take  advantage  of  the  already  developed  ca¬ 
pabilities  of  modeling  complex  structural  members  of  many  well  established  finite  element 
programs  for  vibration  analysis. 

In  the  present  formulatioa,  flexible  bodies  are  represented  by  a  collection  of  fixed¬ 
boundary  free  vibration  modes  plus  some  “static  correction”  or  “constraint”  modes  which 
account  for  local  effects  at  the  boundaries.  The  approach  of  fixed-boundary  mode  was 
chosen  because  it  gives  a  perfect  compatibility  between  bodies,  a  fact  considered  necessary 
to  place  appropriately  the  joints  between  them.  The  body  is  then  linked  to  the  rest 
of  the  system  by  the  selected  joints.  The  degrees  of  freedom  of  the  superelement  are 
the  translations  and  the  rotations  at  boundaries,  plus  a  given  number  of  internal  mode 
amplitudes. 

The  inertia  terms  are  computed  from  a  co-rotationai  approach  in  which  the  consistent 
mass  matrix  provided  by  the  linear  analysis  is  used  but  the  velocities  interpolation  is  not 
kinematically  coherent  with  the  displacements  one.  this  approach  proved  to  be  the  best 
of  all  for  the  simplicity  of  formulation  and  easy  interfacing  of  both  modules.  The  sole 
information  used  from  the  vibration  analysis  module  to  build  the  superelement  are  the 
reduced  stiffness  and  mass  matrices. 

3.2. 1  Kinematics  hypotheses.  Let  x  be  the  position  of  an  arbitrary  point  P  of  the  flexible 
body;  we  write  it  in  terms  of  variables  in  a  local  reference  frame  of  the  body: 

x  =  xo-l-Ro(X-f-u)  (3.2.1) 

where  xo  is  the  position  of  the  local  reference  frame,  Ro  is  the  rotation  of  the  local  frame 
about  the  global  one,  X  is  the  position  of  point  P  in  the  local  frame  and  u  is  the  elastic 
displacement  of  P  measured  in  the  local  frame  (see  fi^e  3.2.1). 


! 

i 

i 

i 
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space,  the  displacements  in  a  local  frame  remain  small  enough  to  assure  the  linearity  of 
relations  between  local  values  of  forces  and  displacements. 


Let  us  also  assume  that  the  dynamic  loading  conditions  are  such  that  the  local  dis¬ 
placements  and  slopes  can  be  accurately  expanded  in  terms  of  a  few  global  shape  functions; 


(3.2.6) 


Here,  4  is  the  set  of  global  shape  functions  and  y  are  the  generalized  displacement  am¬ 
plitudes.  The  equations  above  express  then  a  relation  between  local  relative  displacements 
of  the  body  and  global  absolute  positions,  which  can  be  conveniently  used  to  formulate  a 
disaete  model  of  the  body. 


The  relation  between  local  and  global  variables  can  be  employed  to  make  a  reduced 
model  &om  a  discrete  one.  The  latter  model,  usually  having  a  large  number  of  degrees 
of  freedom,  could  have  been  built  by  using,  for  instance,  the  finite  element  method.  In 
this  case,  equations  (3.2.1, 3.2.3)  can  be  rewritten  at  each  node  of  the  discretization  in  the 
following  form: 


Xo  +  R<i(Xi -1- Ui)' 

_  fxb  +  R«(Xi  +  ^.y) 

♦,  J  - 

[  '®'o'>(*,y) 

where  subindex  i  refers  to  magnitudes  at  node  t,  and  index  0  denotes  the  same  quantities 
computed  at  the  origpn  of  the  reference  frame. 

If  the  Crug  and  Hampton  component-mode  method  [19]  is  followed,  the  global  shape 
functions  are  of  two  kinds; 

[jj]  *BiyB  +  *riyi  (3.2.8) 

equation  in  which  we  distinguish  between  the  boundary  modes  -obtained  by  the  static 
condensation  procedure-  and  the  internal  vibration  modes  -computed  by  fixing  the 
boundaries.  This  particular  choice  of  global  shape  functions  permits  to  represent  both  the 
local  deformation  effects  induced  by  the  joints  acting  on  the  boundary  degrees  of  freedom, 
and  the  global  deformation  effects  induced  by  the  dynamic  behavior  of  the  body  itself. 

The  boundary  generalized  displacements  y^  can  be  computed  in  terms  of  position  and 
rotation  values  at  the  boundary: 


Then,  equations  (3.2.83.2.9)  express  a  kinematics  relation  between  the  local  relative  dis¬ 
placements  at  the  nodes  of  the  disaetized  body,  and  global  absolute  positions  and  rotations. 
These  global  variables  constitute  the  set  of  generalized  displacements  q  of  the  superelement. 


.*  I 


It  is  formed  by  6  degrees  of  freedom  expressing  position  and  orientation  of  the  local  frame. 
3  X  (NBtrat  +  -Vrroi)  degrees  of  freedom  expressing  positions  (at  Nstm,  nodes  of  the 
boundary)  and  orientations  (at  Sb  rot  nodes  of  the  boundary),  and  a  certain  number  of 
internal  modal  amplitudes  y/: 


=  (4  yfl 


(3.2.10) 


Positions  and  rotational  vectors  at  the  boundary  connect  the  body  to  the  rest  of  the 
multibody  system. 

In  what  follows,  we  treat  xb  and  '9b  as  vectors  with  3  components,  but  the  reader 
should  keep  in  mind  that  their  actual  dimension  depends  on  the  number  of  nodes  (and 
degrees  of  freedom)  retained  at  the  boundary. 

3.2.2  Computation  of  the  strain  energy.  The  energy  of  deformation  of  the  body  can  be 
directly  obtained  by  making  the  double  discretization  proce.ss  on  the  continuum  expression 
of  the  strain  energy;  i.e.,  if  x  =  ^  /y.  crc  dV,  the  finite  element  method  gives  a  first  discrete 
equation  as  follows 

r  =  id^Kd  (3.2.11) 

with  d  the  nodal  displacements  vector  and  .K  the  stifihess  matrix.  The  second  discretization 
(expansion  into  the  modal  basis  d  =  9y)  gives  the  expression; 


where  S  is  the  reduced  stiffness  matrix  of  the  body: 


K  = 


(3.2.12) 


(3.2.13) 


We  note  that  in  the  latter  equation  we  used  the  orthogonality  relation  which  characterizes 
the  constraint  modes  (♦gK#/  =  0). 

The  variation  of  generalized  displacements  can  be  computed  in  terms  of  the  variation 
of  the  superelement  degrees  of  freedom  q  as  follows: 

1  [RoC^xb -#xo)  +  (Xb +  Ufl) X  tf0o' 
iy  =  ^■0B  =  SeB-SQo  (3.2.14) 

L  ^y/  J 

By  taking  into  account  equation  (3.2.4)  which  expresses  the  condition  of  small  displacements 
and  rotations  in  the  local  frame,  the  variation  of  displacements  can  be  simplified  to  give; 


R^iSxB  -  ^xo)  +  XbSQo 
S@B  — 
hi 


=  Ydq 


(3.2.15) 
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with  the  definition  of  the  configuration  dependent  matrix 


Y  = 


■-RJ  Xb  0  o' 
0  -1010 
0  0  0  0  1 


and  the  vector  of  generalized  coordinates 


(3.2.16) 


Sxl  S@l  (Jyf]  (3.2.17) 

where  SQq,  SQb  are  respectively  the  angular  displacements  variations  at  the  reference  frame 
and  at  the  boundary  nodes. 

The  internal  forces  vector  of  the  superelement  is  then  calculated  as  follows: 

Sir  =  YTIV  =  Sq^  g<„«  (3.2.18) 


By  differentiating  the  internal  forces  and  by  neglecting  the  derivatives  of  Y,  we  arrive 
at  the  expression  of  the  stiffness  matrix  of  the  superelement: 

^1^]  Aq  is  Y^^Aq  =  S^Aq  (3.2.19) 

with 

S*  =  Y^Y  (3.2.20) 


3.2.S  Co-wtational  evaluation  of  the  kinetic  energy.  The  most  convenient  way  to  evaluate 
the  kinetic  energy  of  the  superelement  in  a  co-rotational  manner 

Here,  Ro  gives  the  rotation  of  the  reference  frame  attached  to  the  elastic  body  at  node  0. 
Let  us  denote  the  co-rotational  velocities  by 


v(X)  =  rJx  (3.2.22) 

and  interpolate  them  in  terms  of  nodal  velocities  in  the  form 

^f{X)  =  'f2Ni{X)Vi  (3.2.23) 

{si 


where  the  summation  extends  to  all  nodes  of  the  flexible  member.  Note  that  this  interpo¬ 
lation  is  not  consistent  with  the  displacement  interpolation  used  to  build  the  strain  energy 


expression  and  also  that,  for  finite  element  models  using  rotational  degrees  of  freedom,  the 
same  interpolation  has  to  be  made  on  the  material  angular  velocities. 


.4fter  perfcming  the  volume  integral,  the  kinetic  energy  of  the  supereiement  can  be 


written: 


=  lEEw  nn/,NrN,p,<F[;;']  =  nriM„ 

t  ]  I  ;  '•  -I 

(3.2.24) 

where  M,y  denotes  the  block  of  the  mass  matrix  coupling  nodes  t  and  j. 

The  next  step  is  to  form  a  reduced  model  by  following  the  component  modes  approach. 
A  second  stage  discretization  is  made  by  assvmiing  that  the  material  velocities  can  be 
expressed  In  terms  of  a  few  global  shape  functions 


=*.y=[(*o«  ♦o*).-  *r.] 


(3.2.25) 


where  the  part  [vj  Oq  ]  corresponds  to  (material)  velocities  at  the  reference  frame,  yr 
are  the  time  derivatives  of  the  internal  mode  ampUtudes,  and  the  contribution  of  (material) 
velocities  at  the  boundary  nodes  of  the  supereiement  can  be  written  in  the  form: 

(vi  nS]  =  [((vf  nf) ...  (vf  nj))  (vf+i ...  (nJVr+t 

(3.2.26) 

Note  that  at  nodes  1;  + 1 ,  . . .  k  -f-  f  of  the  boundary,  only  the  translation  degrees  of  freedom 
have  been  retained  to  form  the  supereiement,  while  at  nodes  k  +  f+1,  ...  k  +  f  +  m 
only  the  rotation  terms  are  conserved.  The  sole  restriction  is  that  the  three  components  of 
translation  and/or  rotation  (if  any)  should  be  incorporated  to  the  model.  The  translation 
material  velocities  are  computed  by  projection  over  the  reference  frame,  while  material 
velocities  are  the  true  material  velocities  at  the  considered  node. 

Even  when  the  flexible  body  suffers  large  rotations,  the  material  velocities  pattern 
does  not  change;  then,  this  second  stage  discretization  continues  to  be  valid  and  we  can 
still  apply  the  same  modal  expansion.  The  total  contribution  of  the  supereiement  to  the 
kinetic  energy  of  the  structure  W  can  then  be  written  as  follows: 


W  =  iy^y  =  i(v?'  SlJ  v?  nS  yf] 


The  constant  mass  matrix  M  in  (3.2.27)  results  from  the  projection  of  the  element  mass 
matrices  over  the  modal  basis 

(3.2.28) 

»  3 

Inertia  forces  are  computed  by  diSereLtiating  the  kinetic  energy.  Its  hrst  variation  is : 

SW  =  &y^Tiy  (3.2.29) 

The  vector  of  variations  of  generalized  velocities  reads  : 

5y^  =  (^vJ  tfvj  dfla  u'yf]  (3.2.30) 

with  the  variations  of  material  and  angular  velocities  at  nodes  0  and  B  computed  from 

Sv  =  Rfltfx  -  tf©o  X  (R^x)  and  tffl  =  iQ  +  Ooxd©  (3.2.31) 
By  introducing  the  latter  expressions  into  (3.2.29)  and  by  integrating  by  parts,  we  get 
W  =  G,'n.r 

=  (P  M  q  -  P  (mW  +  +  U^)  P^  q) 

where  variations  of  the  generalized  displacements  at  the  global  frame  are  given  by  (3.2.17) 
and  where 

q^  =  (xj  nj  x5  Ob  yf]  (3.2.33) 
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(3.2.34) 

Then,  by  differentiating  the  inertia  forces  with  respect  to  the  generalized  accelerations  in 
the  global  frame  q  we  get  the  superelement  tangent  mass  matrix  : 

=  P  M  P^  (3.2.35) 

The  inertia  forces  also  depend  on  the  velocities  q.  In  order  to  get  full  quadratic 
convergence  rate,  it  will  be  necessary  in  some  cases  to  compute  the  gyroscopic  matrix  of 
derivatives  of  the  inertia  forces  with  respect  to  velocities.  This  is  a  non  symmetric  matrix, 
which  proved  to  be  of  value  for  improving  convergence  in  several  examples. 

MU  -  -  v|  -  [mW  +  W^l  'j  (3.2.36) 

antisym. 
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The  antisymmetric  matrix  V  is  defined  by 


V  = 


■  0 
Su  0 


Su  0 
8*0 
8u  B 


8m  b 
0 

■8*  B 


0 


where  vectors  .-.g#  <  are  computed  as  follows: 


(3.2.37) 


(«Jo  8*0  sIb  8*b  8/1  =  q^PM  (3.2.38) 

VVe  note  that  the  pseudo-damping  matrix  is  formed  by  adding  up  two  terms:  a 
symmetric  and  an  antisymmetric  matrix  which  are  clearly  identified  in  equation  (3.2.26). 
We  finally  remark  that  in  this  formulation,  all  contributions  to  the  inertia  terms  (inertia 
forces  Gintr,  mass  matrix  and  pseudo-damping  matrix  C,„p)  are  evaluated  directly 
from  the  reduced  mass  matrix  M,  the  projection  over  the  modal  basis  of  the  finite  element 
mass  matrix.  In  this  way,  we  can  very  easily  interface  the  vibration  analysis  and  the 
mechanism  analysis  modules. 


4.  Finite  Element  Representation  of  Kinematic  Joints 


4.1.  GENERAL  FORMULATION  OF  CONSTRAINTS  (5) 


The  equations  of  motion  of  a  dynsumic  system  subjected  to  holonomic  constraints  have 
already  been  stated  in  the  augmented  lagrangian  form  (2.2.9).  The  role  of  the  penalty 
term  is  essentially  to  add  some  positive  curvature  in  the  range  space  of 
significant  improvement  of  convergence.  Besides,  this  term  assures  the  positive  de^teness 
of  the  displacements-associated  submatrix  of  the  Hessian  matrix,  so  the  only  safeguard  to 
be  implemented  against  the  appearance  of  null  pivots  during  factorization  is  that  terms 
associated  to  the  Lagrange  multipliers  should  be  condensed  after  the  degrees  of  freedom 
participating  in  the  constraint  equation. 


The  extension  to  systems  with  non-holonomlc  constraints  is  straightforward.  The 
equations  of  motion  in  augmented  lagran^an  form  now  have  for  expression 


'Mq-hQfc-hQ„fc  =  g(q,q,i) 

k*^{q,t)  =  0  (4.1.1) 

.  **nfc(q.qt0  =  0 


where  Q;,  and  Q„/^  denote  respectively  the  constraint  forces  arising  from  holonomir  and 
non-holonomic  constraints  _ 

r  ci^  =  Bi{kk+p*,) 

lQ«ft  =  Bjfc(kA  +  p*„a) 


(4.1.2) 
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with  the  Jacobian  matrices  of  holonomic  and  non-hoionomic  constraints 


- 

~  [  3q  , 


(4.1.3) 


It  is  further  assumed  that  the  non-holonomlc  constraints  are  linear  in  the  velocities,  in 
which  case  they  simplify  into  the  form 

^ttK  “  3na(q)q  4"  bna  (4.1.4) 

It  is  worthwhile  noticing  that  the  non  holonomic  constraints  can  also  be  seen  as  derived 
&om  a  '‘pseudo-dissipation  function”  V 

V  -  -  pll^nklP  4  (4.1.5) 

which  generates  the  “dissipation  forces”: 


(4.1.6) 


The  non-holonomic  constraints  contribute  then  to  the  linearized  equations  of  motion  in  the 
form 

'  MAq  4-  C'Aq  4-  S‘Aq  4-  iBj'AA  -h  JbeJ^AA  =  r*  4-  0(A*) 

'  ifcBfcAq=-Jfe*;4-0(A*)  (4.1.7) 

.fcBnaAq  4- 0(A») 

where  r  is  the  residual  vector  of  dynamic  equilibrium 


f  =  g(qi qi  t)  -  Mq  -  Bl{kX  +  p*s)  -  B^^(kX  +  p*„s) 


(4.1.8) 


and  where  the  tangent  stiffness  and  damping  matrices  S*  and  C‘  are  computed  from 
S‘  =  ^  [-g  i-Bj  (kX  +  p^/,)  d-B^A  (fcA4-p*na)]  C‘  =  -—+pBn^BnH  (4.1.9) 

For  sake  of  computational  simpliuty,  the  second-order  derivative  terms  (such  as  the  contri¬ 
bution  of  the  non-holonomic  constraints)  may  be  omitted  from  the  expression  of  the  tangent 
matrix  when  when  computing  a  nonlinear  response  through  Newton-Raphson  iteration.  All 
terms  have  however  to  be  evaluated  to  perform  a  linearized  stability  analysis. 


4.2.  SYMBOLIC  GENERATION  OF  HINGE  JOINT  ELEMENT 


As  an  example,  let  us  consider  the  automatic  generation  of  the  vector  and  matrix  quantities 
involved  in  the  formulation  of  a  hinge  joint  element.  Let 

two  triads  of  orthogonal  unit  vectors  atached  to  nodes  A  and  B  respectively  at  the  initial 


iV 


>•  »  -w* 


I — f 


configuration.  We  suppose  that  we  have  already  computed  the  configuration  of  the  svstem 
at  time  t  (reference  configuration)  and  we  want  to  compute  the  new  situation  at  time 
t  +  At  (actual  configuration).  Let  {/i'j./ii.Mj}  {^,,^'2,^3}  be  the  triads  obtained  by 

mapping  the  initial  ones  into  the  reference  configuTation  via  the  rotation  operators  at  each 
node: 


M'i  =  B.A  «/  Mi  (4.2.1) 

4'.  =  Rb  (,  (4.2.2) 

Finally,  let  and  mapped  into  the  actual  configura- 


Mi  ~  Rj4  ri/Rji  inc  Mi  ~  RxMt 
^  —  Rb  r«/Rfl  in*  —  Rb^, 


(4.2.3) 

(4.2.4) 


The  rotation  operators  R,(,R4  r</.Ri4  ine  give  respectively  the  actual,  reference  and 
incremental  rotations  at  node  A. 

The  hinge  joint  is  modeled  by  introducing  six  constraints:  three  imposing  the  equality 
of  positions  at  the  nodes,  two  fixing  the  rotations  about  two  directions  (figure  4.2.1).  The 
last  constraint  introduces  explicitly  the  joint  angle  a,  and  aUows  thus  to  apply  a  driving 
moment  at  the  hinge. 


sin{$  —  a)  =  0 


(4.2.5) 


sin9  =  ft'^.^"  ,  cos9  =  Mi-^i 


(4.2.6) 


The  equality  of  positions  is  imposed  by  Boolean  identifications  of  the  corresponding 
degrees  of  freedom.  The  last  three  constraints  are  tre;  ted  by  the  augmented  Lagrangian 
procedure. 

Starting  from  the  symbolic  vector  expression  of  the  last  three  constraints,  the  procedure 
DELTA  (cf.  figure  4.2.2)  automatically  computes  the  vector  form  of  the  constraint  gradi¬ 
ents.  Afterwards,  the  procedure  JOINT  computes  the  symbolic  expressions  of  matrix  B 
and  of  the  penalty  term  contribution  to  the  Hessian  matrix,  both  matrices  being  expressed 
in  terms  of  the  elements  of  matrices  R  and  T.  The  knowledge  of  the  symbolic  expression  of 
R  and  T  in  terms  of  the  rotation  parameters  (cf.  section  2.4.1)  permits  to  express  matrix 
B  in  terms  of  these  parameters,  and  through  further  differentiation  the  symbolic  expression 
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of  the  Hessian  matrix  term  involving  the  second  derivatives  of  the  constraints  is  finally 
obtained. 

4.3.  FINITE  ELEMENT  DESCRIPTION  OF  A  FLEXIBLE  SLIDER  [20] 

Most  applications  in  multibody  dynamics  literature  concern  relative  motions  between  bodies 
United  together  through  rigid  joints  as  hinges,  cyUndrical,  prismatic  joints,  etc.  FlexibiUty 
in  joints  have  been  sometimes  considered,  mostly  for  hinges.  Flexible  tracks  can  be  seen 
as  a  special  type  of  joint  with  appUcations  such  as  modeling  of  erectable  booms  in  space, 
dynamic  simulation  of  landing  gears  and  analysis  of  vehicle  /  flexible  guideway  interaction 
for  ground  transportation. 

In  this  section  we  present  a  model  of  flexible  str<ught  sUder  joint.  It  can  be  described 
as  a  straight  Bernoulli  beam  in  a  corotational  flrame  over  which  sUdes  a  third  node.  A  single 
track  can  be  modeled  by  a  series  of  elements  aligned  one  after  the  other.  The  sUding  node 
can  pass  from  one  joint  to  the  next  one  that  represents  the  track,  thus  allowing  to  refine 
the  mesh  up  to  achieving  convergence.  Dynamic  Mction  effects  between  the  sUding  node 
and  the  track  are  also  taken  into  account. 

4.3. 1  Kinematic  Equations.  Let  us  consider  a  straight  flexible  sUder  whose  deformation 
is  parameterized  in  terms  of  the  position  Xa,xb  of  its  two  extreme  nodes  A,  B  and  of  the 
orientation  of  two  orthogonal  triads  Ra,  Kb  attached  to  them.  The  element  has  a  third 
sUding  node  C  which  freely  moves  along  a  rectilinear  trajectory  oriented  parallel  to  the 
principal  axis  of  the  beam.  The  trajectory  can  be  excentric  &om  the  beam  axis.  We  will 
consider  that,  in  a  general  case,  the  sUding  node  C  has  a  second  freedom;  it  can  also  move 
along  a  rectiUnear  trajectory  t5  contmned  into  the  normal  cross  section  of  the  beam  (see 
figure  4.3.1). 
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surface  a£: 

x(»/iO  =  xa  +  R-a(X(»?)  +  u(j?)+  R(r;)(Xi  +ft5))  (4.3.1) 

where  t],^  are  the  coordinates  along  the  principal  axis  ti  and  along  the  secondary  axis  1$, 
x.t,RA  are  the  position  and  rotation  at  node  A,  X{t))  =  r?ti  is  the  reference  position  of 
the  cross  section  centroid  in  the  reference  frame,  u()))  is  the  displacement  of  the  centroid, 
R(j;)  is  the  rotation  of  the  cross  section  with  respect  to  the  reference  frame  Rx,  and  Xi 
gives  the  position  of  an  arbitrary  point  of  the  secondary  trajectory  in  the  cross  section.  The 
reference  frame  t,-  is  oriented  along  the  principal  axes  of  the  beam,  but  the  secondary  axis 
t5  does  not  necessarily  coincide  with  the  principal  axis  tj. 

The  cross  section  centroid  position  in  the  reference  frame  is 

3(»?)  =  X(f7)  +  u(n)  (4.3.2) 

Then,  the  position  of  node  B  results 

XB  =  xx  +  Rx*(i)  (4.3.3) 


where  L  is  the  beam  length. 

We  will  assume  that  the  beam  behaves  like  a  Bernoulli  beam  in  the  local  reference 
frame.  Then,  the  position  and  the  angular  displacement  of  the  cross  section  at  an  arbitrary 
point  of  distance  tj  from  the  ori^n  of  the  reference  frame  is  given  by 


where 


'  •iv) ' 


=  N(»l) 


-  Xx)' 
(-4'x)o«'fl  . 


(4.3.4) 


N(»7)  = 
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0  0  0  0 

0  0  0 

0  (^-^)  0 

0  0  f  0 

0  (-1^  +  ^)  0  {-^  +  ^) 
(^-^)  0  0  0 
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(4.3.5) 


is  the  matrix  of  Hermite  interpolation  functions,  '9 At  '9b  are  the  rotational  vectors  at  nodes 
A,  B  and  o  symbolizes  the  composition  of  rotations. 


Variations  of  positions  and  angular  displacements  in  the  local  frame 
From  equation  (4.3.4),  we  obtain 


f  Hv) 
[stpiv) 


+  Sti 


LV^'b 


(4.3.6) 
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where 


SB 

^B 


and  where  N'(r;)  =  ^  is  the  matrix  of  derivatives  of  the  interpolation  functions.  We 
remark  that  we  take  variations  with  respect  to  t}  since  this  parameter  is  not  fixed  but 
expresses  the  degree  of  freedom  of  the  sliding  node  along  the  principal  axis  of  the  beam. 

By  assuming  that  the  displacements  and  rotations  of  the  cross  section  in  the  reference 
frame  are  small,  we  can  express  the  variation  of  positions  and  rotations  at  node  B  as  follows 


SsB 

■R5(ixB  -  Sxa)  +  XfltfQx 

.^V'a. 

SQb—SQa 

with 


qf  =  (x5  ©5  x5  ©5)  and  B  = 


=  B  tfqi 


Xb  Ri  0 
-I  0  I 


(4.3.7) 


(4.3.8) 


After  replacing  in  equation  (4.3.6),  we  obtain  the  variation  of  positions  and  angular 
displacements 


S${ri) 

Slpiri) 


=  N(»;)B5qi  + 


l^aJ 


Sr, 


(4.3.9) 
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4.3.2  Strain  Energy.  The  internal  strain  energy  of  the  element  can  be  written  in  the  form 


sa 

.•^a. 


(4.3.10) 


where  is  the  submatrix  corresponding  to  node  B  of  the  standard  stiffness  matrix  of 

a  Bernoulli  beam  element. 


The  internal  forces  vector  gi„|  is  computed  by  differentiating  the  strain  energy  with 
respect  to  the  nodal  displacements 


6U  =  SqJ  gi„t  =  dqfB^K<®®> 


•a 

.'IfB 


(4.3.11) 


By  further  differentiation,  and  after  neglecting  the  derivatives  of  B,  we  obtain  the 
tangent  stiffness  matrix 

S*  =  B^K<®®>B  (4.3.12) 

Neglecting  the  derivatives  of  B  is  entirely  compatible  with  the  assumption  of  small  dis¬ 
placements  and  rotations  in  the  local  frame. 
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a.3.3  Constraint  Equations.  Constraints  are  added  to  the  system  to  impose  node  C  to  be 
permanently  in  contact  with  the  sliding  surface: 

V  =  xc  -  Xx  -  RxsCt?)  -  Rx  (l  +  4'in))  (Xi  +  (ts)  =  0  (4.3.13) 

In  order  to  verify  the  sliding  condition  (4.3.13),  the  projection  of  the  vector  v  along  the 
principal  axes  of  the  beam  is  assumed  to  be  zero: 

0,.  =  v^Rxt,-  =  (Rx(xc  -  xx)  -  s  -  (I  +  ^)(Xi  +  fts))  t,  =  0  (4.3.14) 


Variations  of  the  constraints  are  then  given  by 

S6,  =  ixjRxti  -  oxjRxtt  +  ^©x  (t<  X  R-x(xc  -  xx)) 

-  (gs(.?)^t.  +  S-tIJinf  ((X,  +^t5)xt.))  -  S^tJ (I  +  ^)ts 


(4.3.15) 


After  replacing  the  expressions  for  the  variations  of  position  and  orientation  (4.3.9),  the 
underlined  term  on  the  right-hand'Side  can  be  written  as 

Sa(r,fu  +  Si’infiXx  +  ^t.,)  X  [(X,  +  {l^)  x  t. 

(4!3.16) 

By  finally  replacing  the  expression  of  N(>7)  into  (4.3.16)  and  the  latter  one  into  (4.3.15), 
we  obtain: 


^  =«x5Rx(fi  - 1.)  +  «©5  (f,  +  XbA  + 1<  X  r;(xc  -  Xx)) 

-  ^xjRxfi  -  5©sfj  +  tfxjRxt,- 

—  (Xl  +  (ts)  X  ti)  —  ^(I  +  '0)t5t,) 


(4.3.17) 


iui  r  fuii 

fi  -  (^  -  +(x?’ “  (V'ir)*’* +  (“!?■ + 

.(^  -  ^)<<*  “(!?■-  ^)“«J  L(— tT)*f»  +(-^  +  ^’r)«iJ. 

^.3.18) 

Here  f,i,(,],f,3  denote  the  first,  second  and  third  components  of  vector  tj.  The  contribu¬ 
tions  tc  the  internal  forces  vector  and  to  the  tangent  stiffness  matrix  are  then  computed 
according  to  the  procedu.'e  described  in  section  (4.1). 


.(.3.4  Kinetic  Energy.  The  procedure  for  computing  the  kinetic  energy  is  the  same  as  for 
the  superelement  (section  3.2.3).  Using  the  co-rotational  approach,  the  total  contribution  of 


;  ■ 


the  element  to  the  kinetic  energy  of  the  structure  K  can  be  written  as  a  double  summation 
over  'he  nodes  of  the  element  : 

IC=  Y.  (4-3.19) 

where  is  the  contrlbutioa  arising  from  nodes  i  and  j  : 

\  \  (4  =  20) 

Here,  is  the  6  x  6  submatrix  corresponding  to  nodes  »,j  of  a  Bernoulli  beam  finite 
element  mass  matrix: 


M  = 


(4.3.21) 


M<®®) 

and  q,  is  the  6-components  vector  of  generalized  velocities  in  the  local  frame  to  each  node. 

Inertia  forces  are  computed  by  differentiating  the  kinetic  energy.  The  first  variation  of 
the  kinetic  energy  i.s : 

(4.3.22) 

while  the  variation  of  generalized  velocities  at  node  i  reads : 

_  rilf5x,  -^©,  x(Rfx,) 

"  [  5©i  +  X  SQi 

By  introducing  the  latter  expression  into  (4.3.22)  and  by  integrating  by  parts  -  Hamilton’s 
principle  -  we  get 

>.T 


(4.3.23) 


M('j) 


q,  + 


R,n,-  0 

(Rfxi)  n,. 


where  the  acceleration  vector  is 


x,) 


(4.3.24) 

(4.3.25) 


Then,  by  differentiating  the  inertia  forces  with  respect  to  the  generalized  accelerations, 
we  get  the  element  tangent  mass  matrix  M  : 

\T 

(4.3.26) 


■R,  0 

M(v) 

■R,  0 

0  I 

.0  I. 

4.S.5  Dynamic  Friction.  During  motion.  Coulomb  ffiction  effects  generates  forces  between 
node  xc  and  the  sliding  surface.  These  forces  are  directly  proportional  to  the  modulus  of 
the  normal  contact  force  in  the  joint,  through  the  friction  coefficient : 

dqrF,  =  -di?/tfl(.j)||F„||  (4.3.27) 
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where  the  regularized  friction  coefficient  is 


\  I’ll  ^ 


(4.3.23) 


and  where  <„  is  a  small  tolerance  with  dimension  of  speed,  giving  the  velocity  under  which 
one  considers  the  joint  to  be  “stuck"  ,  and  fi  is  the  Coulomb  friction  coefficient. 


Differentiation  of  the  friction  force  leads  to  the  computation  of  the  tangent  damping 
matrix  C /  and  of  the  tangent  stiffness  matrix  S /  : 


with 


and 


'dFf 
.  3q 


Aq  =  C/Aq  =  Vfll|F„||A>) 


(4.3.29) 


(4.3.30) 


The  contact  force  is  given  by  the  Lagrange  multipliers  vector  A  (see  equation  (4.1.2)  - 
the  scaling  factor  k  has  been  neglected  here  for  simplicity)  .  The  normal  contact  force  Fn 
is  obtmned  by  eliminating  all  components  of  the  total  contact  force  into  the  longitudinal 
direction  ti  : 

F„  =  (I  -  titf)R^A  (4.3.31) 

where  R  =  exp(0)  is  the  rotation  of  the  cross  section  at  the  contact  point  (node  C)  with 
respect  to  the  reference  frame  R.4.  The  modulus  squared  of  the  normal  force  is: 

||F„1|»  =  A’’r(I  -  tit?’)R^A  (4.3.32) 

where  we  have  used  the  property 

(I  -  titf  )*  =  (I  -  titf )  V  k  (4.3.33) 


Differentiation  of  equation  (4.3.32)  ^ves 


ailFnii 


aq 


Aq  =  |j^(  (F„  X  A)"’  AV'  +  FJR^AA)  (4.3.34) 


After  replacing  the  expression  of  A‘0  (equation  (4.3.9))  into  (4.3.34),  we  obtain 
[a!|F„in  ^  ^({F„  X  A)''n*B  Aqj 


aq 


+  (F„  X  Xfif'sAr,  +  FJr^AA) 


(4.3.35) 


ftjure  U.h  Cam  and  follower  system.  ^m^e  4.4.2:  Normal  and  tangent  vector 

at  the  contact  points. 
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4.4.1),  ri  being  the  arc-iength  parameter  along  the  curve.  The  curve  r{f])  is  parameterized 
using  a  cubic  spline  interpolation  (21]. 

4.4.2  Kinematics  of  the  cam/follower  pair.  Let  us  consider  a  planar  cam/follower  pair,  as 
.hown  in  figure  4.4.2,  such  that  its  components  can  be  described  by  spline  functions  i{r)) 
and  s(()  in  their  respective  local  coordinate  systems.  The  cam  and  follower  are  shaped 
so  that  only  point  contact  can  occur  between  them,  excluding  any  possi..ulity  of  surface  to 
surface  contact. 

Let  A  and  B  be  two  material  points,  one  at  each  component,  placed  at  the  origin  of  the 
local  coordinate  systems  {/l;zi,yi}  and  Let  also  C  and  D  be  two  nodes  located 

respectively  over  each  external  surface.  The  latter  points  are  not  fixed  to  the  bodies,  but 
slide  over  their  external  surfaces  in  such  a  way  that  they  coincide  with  the  (unique)  contact 
point  when  the  cam  and  follower  come  close  together.  Whenever  the  cams  do  not  stay  in 
contact,  C  and  D  are  placed  so  as  to  be  considered  the  natural  candidates  to  come  into 
contact. 

The  kinematics  of  the  cam/follower  pair  can  be  completely  defined  in  terms  of  the 
coordinates  of  nodes  A,  B,  C  and  D,  the  rotation  parameters  at  nodes  A  and  B  and  the 
curvilinear  coordinates  7  and  {  along  the  external  surfaces  [1,5]: 


[ 


=  (xj  xl  xl  4-5  V  f) 


(4.4.1) 


where  4'^,'I'b  are  the  rotation  parameters  at  nodes  A  and  B,  respectively,  and  q  is  the 
vector  of  generalized  degrees  of  freedom  of  the  joint. 

In  order  to  completely  define  the  cam/foUower  behavior,  we  have  to  specify  two  sets 
of  holonomic  constraints  and  a  contact  law  that  can  be  defined  through  the  use  of  a 
pseudo-potential.  The  equations  of  motion  are  derived  afterwards  following  the  augmented 
Lagrangian  concept  already  described  in  section  4.1. 

Since  nodes  C  and  D  slide  over  the  cams,  their  coordinates  in  the  inertial  frame  are 
related  to  the  coordinates  of  nodes  A  and  B  through  the  expressions 

xc  =  xa  +  Rxr(»?)  XD  =  XB  +  Rbs(0  (4.4.2) 

where  Rx  and  Rb  represent  the  rotation  operators  at  nodes  A  and  B.  They  are  param¬ 
eterized  in  terms  of  the  rotation  parameters  'i'x  These  kinematic  relationships 

constitute  a  first  set  of  holonomic  constraints  to  be  satisfied.  The  following  six  constraints 
are  used  to  impose  them  to  the  system: 

(*1  h  *3)  =  (ef  el*  ef)(xc-xx-Rxr(j7)] 
is  *6)  =  (ef  ef  ej ][xd -xs -Rb8(0) 

where  ei ,  C] ,  63  are  the  three  base  vectors  of  the  cartesian  inertial  system  (see  figure  4.4.2). 

In  order  to  fix  the  curvilinear  coordinates  ij  and  (  along  the  cams  surfaces,  we  have 
to  introduce  two  additional  constraints.  These  restrictions  should  express  the  fact  that  C 
and  D  are  the  natural  candidates  to  come  into  contact.  To  this  end,  the  two  following 
constraints  are  proposed; 

(i)  The  normal  to  the  external  surface  of  the  first  cam  at  the  contact  point  (node  C) 
should  be  perpendicular  to  the  tangent  to  the  external  surface  of  the  second  cam  at 
the  same  point  (node  D)i 

♦t  =  Be  •1/7  =  0  (4.4.4) 

where  nc  is  a  unit  vector  normal  to  the  first  cam  at  C  and  where  t/7  is  a  unit  vector 
tangent  to  the  second  cam  at  D. 

(ii)  Node  D  should  always  be  placed  over  the  normal  to  the  first  cam  at  C: 

♦s  =  tc-(xD-xc)  =  0  (4.4.5) 

This  restriction  is  naturally  verified  whenever  the  two  cams  are  touching  mutually  (i.e. 
when  nodes  C  and  D  coincide). 

The  satisfaction  of  these  two  constraints,  (4.4.4)  and  (4.4.5),  ensures  that  nodes  C  and 
D  are  coincident  with  the  contact  point  when  cam  and.follower  come  close  together. 


The  tangent  and  normal  vectors  to  the  cam  external  surface  are  computed  in  terms 
of  derivatives  of  the  spline  function  describing  the  curve.  The  tangent  vector  tc  and  the 
normal  vector  nc  to  the  first  cam  at  node  C  are 


tc  =  R-zter 


nc  =  R.zt(er  x  u) 


(4.4.6) 


where  is  the  rotation  of  the  cam  expressed  at  node  i4,  and  u  is  a  unit  vector  orthogonal 

to  the  plan  of  the  joint  (see  figure  4.4.2).  The  tangent  and  normal  vectors  to  tne  follower 
at  D  are  similarly  computed,  pving: 


to  =  Rbcs' 


no  =  RB(es'  x  u) 


In  order  to  calculate  the  contact  forces,  we  shottld  knew  the  (normal)  distance  n 
between  cam  and  follower.  This  measure  should  be  able  to  distinguish  between  states  of 
penetration  (qrti  n  <  0)  and  of  separation  of  the  two  bodies  (grti  n  >  0)-  Therefore  it  is 
defined  in  the  form; 

qrcia  =  nc-(XD-Xc)  (4.4.8) 

We  can  impose  afterwards  the  condition  of  non  penetration  through  the  definition  of  the 
pseudo-elastic  potential: 


1  1  .  f  ‘ 

^  ~  2  »  Wth  knpi^rtl  n)  =  \ 


if  qrel  n  <  0 

otbp’-wiie. 


(4.4.9) 


During  dynamic  computations,  spurious  oscillaticns  can  be  developed  associated  to  the 
contact  elastic  potential.  In  order  to  damp  out  these  osdllatioos,  we  include  a  small  amount 
of  dissipation  derived  from  the  following  Rayleigh  dissipation  function: 


with  C„p(grel  n) 


if  qrct  n  <  0 
otherwise. 


(4.4.10) 


The  non  penetration  potential  and  dissipation  functions  so  introduced  give  rise  to  the 
contact  forces.  The  constants  kemt  w<i  Cgont  should  be  chosen  with  caution,  in  order  to 
avoid  numerical  ill-posed  problems.  We  have  obtained  good  results  using  as  pseudo-elastic 
constant  kcont  =  1000  X  k,  where  k  it  the  scaling  factor  of  constraints  (see  section  4.4.2). 

Let  k<7  and  kd  be  the  curvature  of  each  cam  at  the  contact  points  C  and  D.  Curvatures 
can  be  very  easily  computed  as  follows: 


u  X  r'  •  r" 


(4.4.11) 


It  is  easy  to  verify  that  convex  surfaces  yield  positive  values  of  curvattire.  Then,  verification 
of  the  following  inequaUty  ensures  local  mutual  convexity  of  both  surfaces,  leading  to  contact 
unicity  in  a  local  sense: 

Kc  +  XD  >  0  -•  (4.4.12) 
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Stringer  conditions  can  be  demanded,  for  instance  by  asking  that 

min/cc  4- min/co  >  0  (4.4.13) 

1  i 

If  the  latter  condition  is  verified,  unicity  of  solution  is  assured  for  any  relative  position  of 
both  cams. 


4.4‘3  Computation  of  the  element  forces.  In  order  to  compute  the  constraint  forces,  we 
need  the  derivatives  of  constraints  with  respect  to  the  generalized  displacements  vector  of 
the  joint  (equation  (4.1.2)). 

After  defining  the  non  penetration  potential  V  (4.4.9),  we  are  able  to  compute  the 
elastic  contact  forces  as  those  forces  conjugated  to  the  variation  of  distance  between  cam 
and  follower: 

dV  ~  dfref  It  ^np(9rtl  n)  ?r'f  n  —  (4.4.14) 

with  the  elastic  contact  force  Jvta*  =  n)  <lrti  n* 

When  cam  and  follower  are  in  contact,  a  friction  force  can  arise  between  them  owing 
to  the  eventual  difference  of  tangential  speeds.  If  we  postulate  a  Coulomb  mechanism  of 
friction,  this  force  can  be  considered  directly  proportional  to  the  normal  contact  force  and 
to  the  friction  coefficient: 


—  "Sqrtl  t  t)  \^n\ 


(4.4.15) 


where  Sqrei  t  and  qrtt  t  are  the  variation  of  relative  tangential  displacement  and  the  relative 
tangential  velocity  between  ct  uS  at  the  contact  point;  pR  is  a  regularized  friction  coefficient: 


/*«(?«(  0 


u±£LL 


(4.4.16) 


if  \4rtl  »|  >  €v 


and  =  ^eia$  +  IS  the  total  contact  force. 


The  relative  speed  at  the  point  of  contact  can  be  computed  in  terms  of  velocities  at 
nodes  A  and  B: 

q„,  =  Xy»  +  R^nyirl:?)  -  XB  -  RbObsCO  (4.4.17) 


The  tangential  relative  speed  is  obtained  by  projecting  q„|  over  the  tangential  direction. 


5.  Numerical  Examples 


0.1.  RETIL^CTIC.'’  OF  A  THREE-LOxN'GERON  TRUSS 


The  system  to  be  analyzed  is  a  three  longeron  truss  designed  for  use  in  a  structural 
dynamics  and  control  flight  experiment.  Each  bay  of  the  truss  contains  three  longerons 
and  diagonals.  Interfaced  between  each  bay  is  a  triangle  of  batten  members.  The  triangle 
of  batten  members  may  be  envisioned  as  being  in  a  horizontal  plane,  and  has  at  each  vertex 
a  hinge  body  which  connects  two  adjacent  battens.  Also  attached  to  each  hinge  body  are 
two  longerons  and  two  diagonals. 

The  truss  is  deployable,  with  two  bays  deploying  at  a  time.  During  depi-oyment.  two 
batten  triangles  are  held  flxed  while  the  intermediate  one  rotates  about  the  z  axis.  The 
batten  members  coimect  rigidly  to  hinge  bodies,  while  longerons  and  diagonals  and  hinged 
to  them.  To  permit  folding,  the  diagonals  have  mid-hinges  along  their  length.  The  design 
is  such  that  both  fully  deployed  and  folded  conflgurations  are  nearly  stress-free,  while 
signiftcant  bending  and  twisting  may  occur  during  deployment. 


L 


Figure  5.1.1  :  Ont  bay  model  of  the  truss. 


Symmetry  conditions  have  been  used  in  order  to  limit  the  model  to  one  bay.  The  model 
is  made  of  72  physical  elements  (51  beam  elements,  6  ri^d  bodies  and  15  hinge  joints)  and  7 
additional  constraints  to  impose  the  motion,  giving  a  total  of  421  DOF.  The  one  bay  model 
is  shown  in  figure  9.  Symmetry  conditions  with  respect  to  the  horizontal  plane  were  imposed 
at  .rianglz  B.  At  triangle  A,  the  equality  of  vertical  positions  at  nodes  Al,  A2  and  A3  was 
imposed,  while  rotations  were  keeped  free.  These  boundary  conditions  are  in  accordance  to 
those  imposed  at  an  experimental  analysis  of  the  mechanism  [22].  The  influence  of  other 
boundary  conditions  on  efforts  was  detennined  and  reported  in  [23|.  Figure  5.1.1  displays 
the  reference  configuration  (dotted  line)  and  the  initially  stressed  configuration  obtained 
after  assembling.  Retraction  is  simulated  in  two  phases: 

a  in  order  to  unlock  the  mechanism,  mid-diagonal  hinge  points  are  moved  inwards  and 
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normally  to  lateral  faces  (times  0.  to  2..  see  figure  5.1.2). 


b  the  vertical  displacement  of  the  upper  batten  is  then  controlled  up  to  complete  re- 
t'^action  (figures  5.1.3  to  5.1.5).  Figure  5.1.6  displays  a  vertical  projection  of  the  final 
configuration.  Figure  5.1.7  provides  information  about  the  evolution  of  bending  and 
torsion  moments  in  longerons  during  retraction. 

The  kinematic  analysis  was  made  in  80  increments,  with  an  average  of  6.8  iterations  per 
increment.  The  numerical  model  reproduces  well  the  behavior  of  the  experimental  structure. 


Figure  5.1.2  ;  Configuration  at  {=2.s.  Figure  5.1.S  :  Configuration  at  t=4.s. 


•5.2.  LARGE  FLEXIBLE  SATELLITE  ANTENNA 


This  example  shows  an  apUcation  of  the  superelement  concept  to  a  practical  case,  the 
analysis  of  the  deployment  of  a  three-dimensional  satellite  antenna.  The  structure  under 
consideration  is  made  of  five  similar  panels  hinged  together  as  shown  by  figure  5.2.1. 
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Figure  S.i.t  :  geometry  of  S'D 
satellite  antenna. 


Figure  S.i.t :  torque/an  gle  law 
at  the  hinges. 


The  energy  for  deployment  is  provided  by  nonlinear  springs  acting  at  the  hinges,  with 
torque/rotation  angle  law  as  displayed  in  figure  5.2.2.  The  curve  exhibits  hysteresis  in 
the  vicinity  of  the  locking  angle,  with  an  abmpt  change  of  characteristics  at  this  point  (the 
horizontal  scale  was  modified  in  the  figure  to  allow  better  understanding  of  the  phenomena). 
The  first  peak  corresponds  to  the  locking  value  of  the  torque,  while  the  second  one  is 
genera's  by  the  hysteresis  effect  occuiing  at  the  locking/unlocking  phase. 

Each  panel  of  the  real  structure  is  a  stiffened  sandwich  plate  made  of  composite 
material.  It  has  thus  been  modeled  as  a  sandwich  flat  shell  with  orthotropic  stiffness 
properties  and  local  reinforcements.  An  idea  of  the  finite  element  model  is  given  by  figure 
5.2.3  which  shows  a  decomposition  of  the  stracture  into  four  zones  with  different  elastic 
properties.  A  complete  description  of  the  model'is  given  in  [24,25].  Each  substructure  has 
584  DOF  initially  and  is  reduced  to  the  four  connecting  nodes  (the  mid-side  node  along 
each  panel  edge)  plus  four  internal  vibration  modes,  giving  a  total  of  28  DOF  per  panel. 

The  resulting  mechanism  model  used  to  predict  the  dynamics  during  deployment  has 
242  DOF,  with  a  quadratic  mean  bandwidth  of  33.  The  time  integration  of  the  response 
was  performed  on  a  time  interval  of  41s. 

Figure  5.2.4  shows  a  global  view  of  the  deployment  process,  while  figure  5.2.5  displays 


Figurt  5.2.S  :  finite  element  model  and  elastic  properties  of  one  panel. 


the  evolution  of  rotation  angle  at  the  hinges.  As  shown  by  figure  5.2.4,  the  structure 
is  initially  partially  folded  and  complete  deployment  is  achieved  at  time  T  =  Sis.  The 
rotation  angle  at  the  joints,  on  figure  5.2.5,  increases  regularly  up  to  locking  and  then 
oscillates  about  this  value.  We  observe  that  hinge  13  unlocks  at  time  T  =  34  due  to  the 
violent  oscillations  generated  by  locking  at  the  other  joints,  and  at  time  t  =  41.  it  has  not 
reached  the  full  deployment  state.  We  should  point  out,  however,  that  since  the  stiffness 
characteristics  of  the  joints  possess  extremely  abrupt  variations,  the  numerical  simulations 
evidenced  a  nearly  chaotic  behavior  -  a  strong  dependence  of  results  on  the  time  integration 
parameters.  Therefore,  we  are  not  able  to  assert  if  the  unlocking  at  this  joint  is  physically 
consistent  or  if  it  is  purely  numerical,  and  more  complete  tests  should  be  performed  in  order 
to  fully  validate  these  results. 


Figure  5.2.5  :  Evolution  of  the  rotation  angle  of  the  hinges. 


Figure  5.2.4  •  Global  vieic  of  the  deployment  process. 
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5.3.  CAM/FOLLOWER/SPRING  SYSTEM 

The  example  tested  is  that  of  figure  5.3.1:  a  cam/foUower  pair  with  a  constaut  angular  ; 

speed  at  the  input  shaft  is  analyzed,  for  several  functioning  conditions.  The  geometry  of 

the  cam  was  defined  giving  the  eight  points  indicated  in  figure  5.3.2,  and  using  a  cubic 

spline  interpolation  between  them.  The  spring  constant  k  equals  500.  ,  the  unstressed  : 

length  of  the  spring  fo  is  22.5  and  the  mass  of  the  follower  m  is  1.  The  angular  speed  at 

the  input  shaft  is  H  =  1.75rev/s.  All  computations  were  made  using  a  constant  time  step  < 

h  =  0.005s. 

Firstly,  a  purely  kinetostatic  analysis  was  made,  for  which  we  neglect  all  inertia  forces. 

Follower  displacements  are  plotted  versus  time  in  figure  5.3.3.  Also  shown  is  the  input  > 

-v 

» 
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Figure  5.3,1  :  Cam/follomr/spring  system.  Figure  5.3.2  Cam  geometry. 


Figure  5.3.3;  Displacements  in  time  of  Figure  5.3.4  •  Input  torque  in  time  at  the 
the  follower  for  kinetostatic  analysis  driving  shaft  for  the  kinetostatic  analysis 


torque  at  the  driving  shaft  necessary  to  statically  bsdance  at  each  time  instant  the  force 
exerted  by  the  follower  spring  (figure  5.3.4). 

Secondly,  a  dynamic  analysis  was  performed  with  the  system  submitted  to  the  same 
input  (constant  speed  at  the  driving  shaft).  Displacements  of  the  follower  are  essentially 
the  same  as  those  of  the  kinetostatic  analysis.  However,  the  forces  vary  significantly:  figure 
5.3.5  displays  the  evolution  in  time  of  the  contact  forces  between  cam  and  follower  for  both 
kinetostatic  analysis  (continuous  line)  and  dynamic  analysis  (dashed  line). 
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figure  5.3.5:  Contact  forces  between 
ccm  and  follower  for 
the  kinetostatic  analysis 
(continuous  line) 
and  for  the  dynamic  analysis 
(dashed  line). 


Figure  5.3.6:  Contact  forces  between 
cam  and  follower  for 
the  dynamic  analysis. 

Ccont  =  10000  (continuous  line); 
Ccont  —  500  (dashed  line); 

Ccmt  =  0  (points  line) 


It  is  worthwhile  mentioning  that  in  the  dynamic  analysis  oscillations  appear  in  the 
computed  contact  forces.  These  oscillations  are  of  a  purely  numeric  origin  and  are  directly 
related  to  the  values  assigned  to  the  contact  stiffness  kcont  contact  dissipation  Ccont- 
Computations  of  figure  5.3.5  where  obtmned  using  a  value  of  Ccont  =  10000  for  the  contact 
dissipation  constant.  When  deaeasing  this  value,  the  force  oscillations  are  magnified,  as 
shown  in  figure  5.3.6.  Clearly,  the  value  of  Ccent  greatly  influences  the  results.  It  should 
thus  be  chosen  with  caution  by  following  a  trial  and  error  procedure. 

The  influence  of  friction  is  directly  evidenced  by  the  required  computed  torque  to 
sustain  motion.  Figure  5.3.7  compares  the  required  input  torque  for  two  different  conditions: 
with  friction  -/r  =  0.2-  (continuous  line)  and  without  friction  (dashed  line).  We  can 
appreciate  that  the  integral  of  the  input  torque  over  one  period  is  null  in  the  case  of 
zero  friction. 

When  increasing  the  mass  of  the  follower,  we  can  arrive  to  a  situation  in  which 
continuous  contact  between  bodies  is  not  further  assured.  In  figure  5.3.8  we  plot  the 
computed  displacements  of  the  (candidate)  contact  points  of  the  cam  (continuous  line) 
and  of  the  follower  (dashed  line)  for  this  system.  We  see  that  the  motion  of  the  follower  is 
almost  chaotic,  jumping  continuously  over  the  cam.  Figure  5.3.9  displays  the  configurations 
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Figure  5.3.1:  Input  torque  at 
the  driving  shaft. 

With  friction  (continuous  line)  and 
without  friction  (dashed  line). 


Figure  5.3,8;  Displacements  of 
node  C  (cam,  continuous  line)  and  of 
node  D  (follower,  dashed  line). 


in  time  of  the  system  during  the  first  revolution  of  the  cam,  for  a  case  in  which  the  follower 
mass  is  rmsed  to  m  =  15. 

»4l0 

— 


Figure  5.3.9:  Evolution  of  the  cam/foilower  system 
between  times  0  and  0.665  s  (first  revolution). 


6.  references 


1.  CARDONA  A..  An  integrated  approach  to  mechanism  analysis,  PhD  thesis.  Universite 
de  Liege,  Faculte  des  Sciences  Appiiquees  (1989). 

2.  GERADIN  M.,  PARK  K.C.  and  CARDONA  A..  On  the  representation  of  finite  rota¬ 
tions  in  spatial  kinematics,  LTAS  report,  University  of  Liege,  Belgium  (1988). 

3.  CARDONA  A.  and  GERADIN  M.,  A  beam  finite  element  non  linear  theory  with  finite 
rotations,  Int.  Jour.  Num.  Meth.  Engng.  Vol.  26,  pp.  2403-2438  (1988). 

4.  CARDONA  A.,  GERADIN  M..  GRANVILLE  D.  and  RAEYMAEKERS  V.,  Module 
d’analyse  de  mecanismes  flexibles  MECANO  -  Manuel  d’utilisation,  LTAS  report, 
Universite  de  Liege  (1988). 

0.  CARDONA  A.,  GERADIN  M.  and  DOAN  D.B..  Rigid  and  flexible  joint  modelling  in 
multibody  dynamics  using  finite  elements.  Comp.  Meth.  Appl.  Mech.  Engng.,  Vol.  89, 
pp.  395-418  (1991). 

6.  NEWMARK  N.M.,  A  method  of  computation  for  structural  dynamics,  Jnl.  Eng.  Mch. 
Div.  ASCE,  No.  85  (EM3),  proc.  paper  2094,  pp.  67-94  (1959). 

7.  GERADIN  M.,  RKEN  D.,  Theorie  des  Vibrations,  Masson  Ed..  Paris  (1992). 

8.  FARHAT  C.,GRIVELLI  L.  and  GERADIN  M.,  On  the  spectral  stability  of  time  inte¬ 
gration  algorithms  for  a  class  of  constrained  dynamics  problems,  ALAA  paper  93-1306, 
SDM  93  conference.  La  Jolla,  CA,  (AIAA,  1993). 

9.  CASSANO  A.  and  CARDONA  A.,  A  comparison  between  three  variable-step  algo¬ 
rithms  for  the  integration  of  the  equations  of  motion  in  structural  dynamics,  Jnl  of 
Latin  American  Research,  Vol.  21,  pp.  187-197  (1991). 

10.  CARDONA  A.  and  GERADIN  M.,  Numerical  integration  of  second  order  differential 
algebraic  systems  in  flexible  mechanism  dynamics.  Computer  Aided  Analysis  of  Rigid 
and  Flexible  Mechanical  Systems,  NATO/ASI,  Troia,  Portugal  (1993). 

11.  DUYSENS  J.  and  GERADIN  M.,  Contribution  of  a  symbolic  calculation  code  to  the 
elaboration  of  a  finite  element  calculation  code:  a  first  application  to  the  dynamic 
behavior  of  flexible  mechanisms,  LTAS  report  VA  87,  University  of  Liege,  Belgium 
(1992). 

12.  DUYSENS  J.  and  GERADIN  M.,  Flexible  multibody  dynamics  analysis:  a  finite  ele¬ 
ment  approach  aided  by  computer  algebra,  Proc.  Int.  Workshop  on  Mechanism  Design 


374 


if 


and  Anaiysis  (COMES’93).  Clermont-Fd.  France.  17-18  May  1993. 


13.  CHART  B.  et  al.,  MAPLE  V'-  Langtiage  nfennce  manual.  Springer- Verlag  (1991). 

14.  SIMO  J.  C.,  A  finite  stmm  beam  formulation.  The  three-dimensional  dynamic  problem. 
Part  I,  Comp.  Meth.  Appl.  Mech.  Engng.,  Vol.  49.  pp.  55-70  (1985). 

15.  SIMO  J.  C.  and  VU-QUOC  L,  A  three-dimensional  finite  strain  rod  model.  Part  II: 
computational  aspects.  Comp.  Meth.  Appl.  Mech.  Engng.,  Vol.  58,  pp.  79-116  (1986). 

16.  PARK  K.C.,  Flexible  beam  dynamics:  part  I-  formulation,  Center  for  Space  Structures 
and  Control,  University  of  Colorado,  Boulder  (1986). 

17.  HUGHES  T.J.R.,  The  finite  element  method  :  linear  static  and  dynamic  finite  element 
analysis,  Prentice  Hall,  Englewood  Cliffs,  NJ  (1987). 

18.  GERADIN  M.and  CARDONA  A.,  Substructuring  techniques  in  flexible  multibody  sys¬ 
tems,  Eight  VPI  ic  SU  Symposium  on  Dynamics  and  Control  of  Large  Space  Structures, 
May  6-8,  1991. 

19.  CRAIG  R.  and  BAMPTON  M.,  Coupling  of  substructures  for  dynamic  analysis,  AIAA 
jnl,  vol.  6,  No.  7,  pp.1313-1319  (1968). 

20.  CARDONA  A.  and  GERADIN  M.,  Finite  element  modeling  of  flexible  tracks,  Proc. 
Int.  Conference;  Dynamics  of  flexible  structures  in  space,  Cranileld,  UK,  15-18  May 
1990. 

21.  CARDONA  A.  and  GERADIN  M.,  Kinematic  and  dynamic  analysis  of  mechanisms 
with  cams.  Comp.  Methods  Appl.  Mech.  Eng.,  No.  103,  pp.  115-134  (1993) 

22.  HOUSNER  J.,  Private  communication  (1987). 

23.  GERADIN  M.  and  CARDONA  A.,  Analysis  of  the  retraction  of  a  deployable  three 
longeron  truss,  LTAS  report,  University  of  Liege  (1987). 

24.  GERADIN  M.,  CARDONA  A.  and  GRANVILLE  D.,  Deployment  of  large  flexible 
space  structures,  in  space  vehicle  flight  mechanics,  Agard  conf.  proceedings,  pp  28-1  - 
28-11  (1989). 

25.  GRANVILLE  D.  and  GERADIN  M.,  Calcu^  de  deploiements  d'antennes  par  MECANO, 
LTAS  report  VF  62,  Universite  de  Li^e  (1989). 

26.  CARDONA  A  and  GERADIN  M.,  Time  integration  of  the  equations  of  motion  in 
mechanisms  analysis.  Computers  and  Stuctures,  Voi.33,  No.  3,  pp.  801-820  (1989). 


375 


SUBSTRUCTURING  IN  FLEXIBLE  MULTIBODY  DYNAMICS 


A.  A.  SHABANA 

Depflriment  of  Mechanical  Engineering 
Univt.  tty  of  IlUnou  at  Chicago 
P.  0.  Box  434s 
Chicago,  Illinots  60680 


ABSTRACT.  A  nonlinear  finite  element  formulation  for  flexible  multibuUv  dynamics  is  suiiiiiia- 
riied.  In  this  formulation,  it  is  required  that  the  element  shape  functions  can  describe  Ur^e  rigid 
body  translations.  Of  particular  interest  in  the  dynamics  and  control  of  flexible  inultibody  sys¬ 
tems  it  the  concept  of  equivalent  systems  of  forces.  The  formulation  of  the  generalised  forces  and 
the  nonlinear  dynarmc  equations  of  substructures  in  flexible  inultibodv  dynanucs  is  discussed  and 
the  validity  of  using  the  linear  theory  of  elastodynamics  in  mechanical  system  applications  such  os 
tracked  vehicles  is  reexamined. 


1.  Introductioa 

The  fact  that  most  of  the  element  shape  functions  can  be  used  to  describe  large  transla¬ 
tional  displacements  is  crucial  in  the  development  of  the  nonlinear  dynamic  formulation  of 
substructures  in  multibody  dynamics.  By  using  this  fact  and  a  set  of  coordinate  systems 
that  define  the  configuration  of  the  finite  element,  the  nonlinear  generalized  Neivton-Euler 
equations  of  the  substructures  that  undergo  large  rigid  body  displacements  can  be  developed 
usmg  the  principle  of  virtual  work  m  dynamics  or  Lagrange 's  equation.  These  equations  can 
be  expressed  in  terms  of  a  unique  set  of  invartants  of  motion  that  depend  on  the  assumed 
displacement  field  and  can  be  evaluated  in  advance  in  a  preprocessor  computer  program. 

In  developmg  the  equations  of  motion  of  the  substructures  in  multibody  dynamics, 
special  attention  must  be  paid  to  the  definition  of  forces  and  moments.  The  concept  of  the 
equivalence  of  two  systems  of  forces  in  rigid  body  dynanucs  is  not  applicable  to  deformable 
body  dynamics.  A  force  that  acts  at  a  point  on  a  deformable  body  is  equivalent  to  a  system, 
defined  at  another  point,  that  consists  of  the  same  force,  a  moment  that  depends  on  the 
relative  displacement  between  the  two  points,  and  a  set  of  generalised  elastic  forces  that 
depends  on  the  finite  rotation  of  the  body.  This  is  a  subject  of  particular  interest  in  control 
applications,  since  in  many  cases  the  motion  of  the  system  is  specified  and  the  interest  is 
focused  on  defining  the  joint  control  forces  that  produces  the  desired  motion.  Nonetheless, 
a  close  exanunation  of  the  structure  of  the  mass  matrix  and  the  forces  in  deformable  body 
dynamics  and  the  proper  identification  of  the  invariants  leads  to  a  systematic  procedure  for 
the  automatic  generation  of  the  inertia  and  stiffoess  characteristics  of  deformable  bodies  in 
multibody  systems 

Once  the  structure  of  the  nonlinear  dynamic  equations  that  govern  the  unconstrained 
motion  of  deformable  bodies  is  defined,  two  approaches  can  be  used  to  formulate  the  multi- 
body  equations  of  motion.  These  are  the  augmented  and  the  recursive  formulations.  In 
the  augmented  formulation,  the  multibody  cquatiosu  of  motion  are  formulated  in  terms  of 
a  set  of  variable  that  include  both  the  dependent  and  independent  coordinates.  In  this 
type  of  formulation,  constraints  between  the  variables  are  formulated  using  a  set  of  linear 
and/or  nonlinear  algebraic  constraint  equations  that  depend  on  the  system  coordinates  and 


possibly  on  tune.  This  leads  to  a  nuxed  system  of  algebraic  and  differential  equations  that 
must  be  solved  simultaneously  using  matm  and  computer  methods.  In  the  recursive  formu¬ 
lations.  the  equations  of  motion  are  formulated  m  terms  of  the  joint  variables  or  the  system 
degrees  of  freedom.  This  leads  to  a  smaller  system'of  strongly  coupled  equations.  In  this 
case,  one  obtains  only  a  set  of  differential  equations  that  can  be  integrated  numerically  in 
order  to  define  the  state  of  the  system. 

Another  topic  of  particular  significance  in  the  analysis  of  substructures  in  multibody  dy- 
nanucs  is  the  coupling  between  the  displacements.  The  coupling  between  the  finite  rotations 
and  the  deformation  displacements  has  a  significant  effect  on  the  dynamics  of  deformable 
bodies.  Significant  changes  in  the  wave  phenomenon  occur  as  the  result  of  the  finite  rota¬ 
tion.  For  example  elastic  waves  in  a  perfectly  elastic  nonrotating  rods  propagate  with  the 
same  phase  velocity.  Consequently,  the  group  velocity  is  constant  and  is  independent  of  the 
wave  number  or  the  dimension  of  the  rod.  Dispersion,  however,  occurs  as  the  results  of  the 
finite  rotation  and  its  coupling  with  the  deformation  displacements.  The  phase  velocities  of 
harmomc  waves  are  no  longer  equal  and  consequently  the  group  velocity  becomes  dependent 
on  the  wave  number. 


2.  Finite  Rotations 

In  the  transient  finite  element  dynamic  analysis,  a  convected  coordinate  system  is  attached 
to  each  finite  element  and  hence  it  shares  its  rigid  body  motion.  A  sequence  of  fixed  co¬ 
ordinate  systems  are  introduced  and  at  any  instant  of  time  it  is  assumed  that  the  axes  of 
the  convected  system  coincide  with  the  axes  of  one  of  the  fixed  coordinate  systems.  By 
assuming  that  there  is  a  relatively  sufficient  number  of  fixed  frames,  the  displacement  of 
the  element  between  two  coordinate  frames  is  described  using  the  shape  function  and  the 
nodal  coordinates  of  the  element.  The  current  deformed  state  is  used  as  the  new  reference 
state  prior  to  the  next  incremental  step  in  the  transient  dynamic  solution.  The  updated 
Lagrangian  formulation  leads  to  a  simple  dynamic  equations  in  which  the  element  mass 
matrix  defined  in  the  convected  coord^ate  system  is  constant.  Furthermore,  the  use  of 
the  lumped  mass  technupte  leads  to  constant  element  mass  matrix  in  the  global  coordinate 
system.  Since  several  of  the  commonly  used  shape  functions  of  beams,  plates  and  shells  can 
not  be  used  to  describe  finite  rotation,  several  of  existing  finite  element  formulations  lead 
to  a  subtle  linearisation  of  the  resulting  dv  .antic  equations.  The  limitations  on  the  use  of 
the  commonly  employed  shape  functions  ^he  large  displacement  analysis  of  deformable 
bodies  can  be  demonstrated.  To  this  end,  we  use  the  shape  function  of  the  six  degree  of 
freedom,  two  node  planar  beam  element.  Each  node  is  assumed  to  have  three  coordinates; 
two  describe  the  translation  and  one  describes  the  slope  at  this  nodal  point.  The  vector  of 
nodal  coordinate  of  the  element  ;  on  the  deformable  body  t  can  be  written  as 


where  e‘,^,  Cj ,  e'^  and  ej^  are  the  translational  nodal  coordinates,  while  elj  and  eg  are  the 
sbpes  at  the  two  nodal  points.  An  element  shape  function  associate-!  with  this  set  of  nodal 
coordinates  is 

a.r  _  f  1  -  f  0  0  (0  0 

^  [  0  -!•(*)  0  3F*-2{'* 

where  ^  =  */f,  and  s  is  the  spatial  coordinate  and  I  is  the  length  of  the  element.  A  general 


rigid  body  truisiacion  can  be  described  by  the  vector 


R  = 


R.  R,\ 


(3) 


where  R,.  and  R,j  are  the  displacement  of  an  arbitrary  point  on  the  element.  As  the  result 
of  this  rigid  body  translation,  the  vector  of  nodal  coordinates  becomes 


+  e‘i  +  R.j  e\^  +  R,  e'^  + /J, 


=  e'-'  -  a. 


(4) 


where  e‘-'  as  defined  by  Eq.  1  is  the  vector  of  nodal  coordinates  before  the  rigid  body 
translation  and  R.  is  the  vector 

a.  =  R^  R,,  0  R^  R.J  0 

By  using  simple  matrix  multiplication,  it  can  be  shown  that 


That  IS 


§‘»R,  =  R 

S'^  «;•'  =  c'-'  i-  B,.  =  S  e'-'  +  a 


This  Implies  that  the  element  nodal  coordinates  can  be  used  to  describe  an  arbitrarily  large 
rigid  body  translation.  This  it  a  basic  assumption  which  is  utilized  in  our  formation  and 
Its  significance  becomes  apparent  when  the  dynamic  equations  are  formulated  in  lenns  of 
a  mmimum  number  of  independent  invariants  of  motion. 

2.:.  FINITE  ROTATION 

If  the  finite  element  undergoes  a  pure  rotation  defined  by  the  angle  9,  the  position  vector 
of  an  arbitrary  point  gt  a  distance  x  from  its  end  as  the  result  of  this  rotation  is 


(5) 


«  !  _ 

\  cotS 

-sintf  1  X 

zcos^ 

[  sin^ 

co$9  j  0 

Xiin9 

Using  this  equation  and  the  definition  of  the  slope,  one  hat 

t'-i  =  4  =  ^ 

In  this  case,  the  vector  of  nodal  coordinates  becomes 


(8) 


=  i  0  0  find  Icoid  lim9  sin9 
where  /  is  'he  length  of  the  element.  It  can  be  shown,  by  direct  matrix  multiplication,  that 

I  xeo%9  ] 


[  ziin^ 
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Thu  u,  the  shape  function  of  the  beam  element,  as  defined  by  £q.  2,  can  be  used  to 
describe  finite  rotations  provided  that  the  slopes  at  the  nodal  points  wau  be  defined  using 
tngonomeinc  /unctions  u  in  Eq.  -6.  In  the  finite  eleraent  formulation  such  definition'  can  not- 
be  made  since  trigonometric  functions  lack  any  physical  meaning.  The  use  of  trigonometric 
functions  to  define  the  nodal  coordinates  introduces  technical  difficulties  in  assembling  the 
finite  elements  and  in  transforming  the  nodal  coordinates  from  one  coordinate  system  to 
another.  On  the  other  hand,  if  the  rotation  is  assumed  to  be  small,  one  hat 


Infimtenmal  rotations  can  be  treated  as  vectors.  Therefore,  the  rule  of  transforming  vectors 
from  one  coordinate  system  to  another  can  be  ^plied  to  the  transformation  of  the  nodal 
coordinates.  Furthermore,  the  slopes  as  defined  by  the  preceding  equation  have  physical 
meaning  and  consequently  no  technical  problems  arise  when  the  elements  are  assembled. 


2.2.  COORDINATE  SYSTEMS 


Using  a  similar  procedure  as  the  one  described  in  this  section,  it  can  be  ahevn  that  most  of 
the  commonly  used  shape  functions  can  describe  an  arbitrary  large  rigid  body  translations. 

As  demonstrated  by  the  beam  example  presented  in  this  section,  some  of  the  shape  functions 
can  not  be  used  to  describe  an  arbitrary  finite  rotation  of  the  element.  Even  though  in 
the  eases  where  the  element  nodal  coordinates  can  be  used  to  describe  finite  rigid  body  << 

rotations  as  in  the  ease  of  tnangular,  rectangular,  solid  and  tetrahedral  elements,  the  use  of 
the  nodal  coordinates  is  not  convenient  in  describing  the  relative  Unite  rotations  between  « 

the  components  of  the  multibody  system.  ' 

Using  the  fact  that  the  element  shape  function  can  be  used  to  describe  an  arbitrary 
large  rigid  body  translation,  the  location  of  an  arbitrary  point  on  the  element,  as  shown 
in  Fig.  1,  can  be  defined  in  an  intermediate  element  coordinate  system  2'^  whose 

axes  are  parallel  to  the  axes  of  the  element  coordinate  system  X'^  Y'^  Z*'  as 


ay  =  §•'  (ey  +  e‘j)  (7\ 

where  a'/  is  the  position  vector  of  the  arbitrary  point  on  the  element  defined  in  the  interme* 
diate  element  coordinate  system,  Cg  is  the  vector  of  nodal  coordinates  in  the  undeformed 
state  and  e'j  is  the  vector  of  nodal  deformations.  The  origin  of  the  intermediate  element 
coordinate  system  X'’  Y*’  Z'>  it  assumed  to  be  rigidly  connected  to  the  origin  of  the  body 
coordinate  system  X'  Y'  Z*.  In  this  cate,  the  global  position  vector  of  an  arbitrary  point 
on  the  element  j  on  the  deformable  body  s  can  be  written  as 

r‘^  =  R*  +  A*’  Q*^'  (8) 

where  E*  it  the  global  position  vector  of  the  origin  of  the  body  coordinate  system.  A'  is  the 
transformation  matrix  from  the  body  to  the  global  coordinate  system  and  is  the  local 
position  vector  of  the  arbitrary  point  defined  as 

Q.r  ^  (9) 

in  which  B'^  is  the  Boolean  matrix  t^t  describes  the  element  coimeetivity,  B‘  it  the  matrix 
of  the  reference  conditions  that  elimmate  the  rigid  body  motion  of  the  substructure  with 
respect  to  its  coordinats  system,  q*y  it  the  vector  of  elutic  coordinates  of  the  deformable 


Figure  1.  Coordinate  ly stems 


body  i  and  S'^  is  the  shape  matrix  of  the  element  j  defined  in  the  body  coordinate  system. 
Note  that  this  description  of  motion  does  not  imply  any  linearization  of  ,i  kinematic 
relationships  provided  that  the  element  rotations  in  the  case  of  beams  ana  lates  with 
respect  to  the  body  coordinate  system  are  assumed  to  be  small.  If  the  shape  function 
of  the  element  can  be  used  to  describe  arbitrary  finite  rotations  such  as  in  the  case  of 
two  dimensional  triangular  and  rectangular  elements  and  in  the  case  of  three  dimensional 
solid  and  tetrahedral  elements,  the  kinematic  equations  presented  in  this  section  can  be 
used  without  any  assumption  of  linearization  in  the  large  deformation  analysis  of  fiezible 
multibody  systems. 


3.  Inertia  Forces 


Several  techniques  can  be  used  to  derive  the  dynamic  equations  of  the  deformable  body 
i  that  undergoes  large  rigid  body  displacements.  In  the  cue  of  unconstrained  deformable 
body,  the  application  of  the  principle  of  vtrtuaJ  work  in  dynamics  leads  to 


Ql  =  Qi 


(10) 


where  Qj  is  the  vector  of  the  generalized  inertia  forces  and  Q‘  is  the  vector  of  applied  external 
and  elastic  forces.  In  Lagrange’s  equation  the  generalized  inertia  forces  are  expressed  in 
terms  of  the  kinetic  energy,  while  in  Gibbs- Appel  equation  the  generalized  inertia  forces 
are  expressed  in  terms  of  the  acceleration  fimction.  Both  can  be  derived  using  the  basic 
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k'‘ 


definition  of  the  virtual  work  of  the  inertia  forces  defined  as 


sw,  =  /  y  sy  dv'  =  /  ^  sq'  dv' 

Jv‘  Jv‘  oq‘ 

=  qf  Sq‘  (11) 

where  p‘  and  V'  are,  respectively,  the  mast  density  and  volume  of  the  deformable  body  t,  r‘ 
IS  the  acceleration  vector  of  an  arbitrary  point  on  the  deformable  body  and  q*  is  the  vector 
generalised  coordinates  of  the  body  whi^  can  be  defined  using  the  absolute  reference  and 
the  elastic  relative  coordinates  as 


q‘  ^ 

IT  T  T  l'^ 

=  !  R*’'  d‘^  q'/  j 

(12) 

in  which  6'  is  the  set  of  rotational  coordinates  used  to  describe  the  orientation  uf  the 
deformable  body  and  R‘  and  q)  are  as  previously  defined.  It  follows  from  £q.  1 1  that  the 
generalised  inertia  >  ..'ces  are 

or 

(13) 

which  ii  the  same  as 

Ql 

(14) 

since 

dy  5f* 

5q‘  ~  dq' 

(15) 

Using  £q.  10,  the  kinematic  relationships  presented  in  the  preceding  section,  and  the 
reiationsUp  between  the  angular  acceleration  a'  of  the  coordinate  system  of  the  deformable 
body  (  and  the  time  derivatives  of  the  orientational  coordinates,  one  obtains  the  generalized 
Newton- Euler  equations  for  the  deformable  body  u 


ml  , 

R* 

[  Qr  1 

a‘ 

q:. 

+ 

F.‘. 

symmetric 

*"//  . 

.  . 

[Q>  -  K',,q)  J 

[*'/  J 

where  tn),;],  m‘nf,  and  are  the  components  of  the  mass  matrix,  is 

the  stiffness  matrix,  Q'  =  j  ]  is  the  vector  of  externally  applied  forces, 

IT  T  T  ^  ^ 

F)i  F'l  I  ia  e  quadratic  velocity  vector  that  absorbs  the  Coriolis 

and  the  centrifugal  force  components. 


4.  Invariants  of  Motion 

At  the  result  of  the  finite  rotation,  the  mast  matrix  of  Eq.  16  is  a  nonlinear  function 
of  the  coordinates  while  the  Coriolis  and  centrifugal  forces  are  nonlinear  functions  of  the 


coordinates  and  velocities.  It  can  be  shown,  however,  that  the  nonlinear  mass  matrix  and 
the  nonlinear  Corio.'ii  and  centrifugal  forces  can  be  expressed  in  terms  of  a  set  of  invariants 
that  depend  on  the  assumed  displacement  field.  These  invariants  can  be  developed  for  each 
finite  element  j  on  the  deformable  body  t.  The  invariants  of  the  deformable  body  i  can 
then  be  obtained  by  assembling  the  invariants  of  its  finite  elements  using  a  standard  finite 
element  assembly  procedure.  If  the  shape  function  of  the  finite  element  can  be  used  to 
describe  large  rigid  body  translations  in  three  orthogonal  directions,  it  can  be  shown  that 
the  invariants  of  the  element  j  on  the  deformable  body  t  are 

r/  =  (17) 

V',  =  p‘^sf  sy  ifc,/  =  1.2,3  (18) 

where  p‘^  and  V'^  are,  respectively,  the  mass  density  and  volume  of  the  element  j  and  Sy 
is  the  Jbth  row  of  the  element  shape  function.  The  invariants  of  the  body  t  can  simply  be 
obtained  as 

r,  =  Er/  (19) 

}-i 


lu  =  (20) 

where  n,.  is  the  total  number  of  the  finite  elements  used  to  discretize  the  deformable  body 

I. 

The  invariants  of  Eqs.  17  and  18  are  given  in  their  consistent  mass  form.  These  invari¬ 
ants  can  also  be  expressed  in  a  lumped  mass  form.  In  this  later  case,  the  structure  of  the 
mast  matrix  does  not  change  and  it  remains  nonlinear  fimction  of  the  coordinates. 


5.  Equivalent  Syatema  of  Forces 

In  rigid  body  dynamics,  a  force  that  acts  at  a  point  on  the  body  it  equivalent  or  equipollent 
to  a  system  of  forces,  defined  at  another  point,  that  consists  of  the  same  force  and  a  moment. 
Consequently,  the  force  it  defined  by  its  magnitude,  direction  and  its  point  of  application. 
On  the  other  hand,  a  moment  in  rigid  body  dynamics  is  a  /ree  vector  which  it  independent 
of  a  point  of  application.and  it  defined  only  by  its  magnitude  and  direction.  In  deformable 
body  dynamics,  however,  a  force  that  acts  at  a  point,  is  equivalent  to  the  same  force,  a 
moment  that  depends  on  the  deformation  of  the  body,  ind  a  set  of  generalized  elastic  forces 
that  depend  on  the  finite  rotation  and  the  assumed  displacement  field.  Furthermore,  a 
moment  in  flexible  body  dynamics  is  no  longer  a  free  vector,  it  is  defined  by  its  magnitude, 
its  direction  and  its  point  of  application. 

In  many  control  applications,  the  desired  motion  of  a  system  is  specified  and  the  interest 
is  focused  on  determining  the  joint  control  forces  that  produce  this  desired  motion.  This 
inverse  dynqrntcs  problem  must  be  carefully  handled  in  view  of  the  definition  of  forces  and 
moments  in  flexible  body  dynamics.  Fig.  2  shows  a  model  of  a  one  degree  of  freedom  slider 


craiik  meclianism.  lit  this  model,  die  connecting  rod  A3  is  assumed  tiexible.  The  motion 
of  the  slider  block  at  3  is  assumed  to  be  specified  at  a  function  of  time  and  given  by 

x'*  =  0.35  -  0.8  smwt  (21) 

where  w  =  150  rod/s  is  the  frequency  of  the  motion  of  the  slider  block,  =  0.15m 
IS  the  length  of  the  crankshaft.  Figure  3  shows  the  crankshaft  torque  that  is  required  to 
produce  the  desired  motion  of  the  slider  block.  The  results  presented  in  Fig.  3  are  obtained 
by  solving  the  inverse  dynamics  problem  in  the  cate  of  rigid  and  flexible  body  dynamics.  In 
the  case  of  rigid  body  dynamics  one  needs  to  solve  a  system  of  algebraic  equations.  In  the 
inverse  dynamics  of  flexible  multibody  systems,  one  obtains  a  set  of  differential  equations 
which  must  be,  in  general,  integrated  numerically  because  of  the  elastic  degrees  of  freedom. 
In  this  cate  one  obtains,  in  addition  to  the  crankshaft  torque,  a  set  of  generalised  forces 
associated  .with  the  generalised  elastic  coordinates  of  the  connecting  rod.  These  generalised 
elastic  coordinates  depend  on  the  boundary  conditions  of  the  flexible  connecting  rod.  If  the 
connecting  rod  is  modeled  u  a  simply  supported  beam  and  the  motion  of  the  slider  block 
is  prescribed,  the  generalized  elastic  forces  are  not  equal  to  zero  provided  that  at  least  one 
axial  mode  of  vibration  it  included  in  the  finite  dimensional  model. 


6.  Modal  Coordinates 

The  generalized  Newton-Suler  equations  as  defined  by  Eq,  16,  are  formulated  in  terms  of 
a  coupled  -set  of  reference  and  elastic  nodal  variables.  Tltis  is  i  finite  element  formula¬ 
tion  which  was  obtained  using  the  physical  nodal  coordinates  of  the  finite  element  used  to 
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Figure  3.  Solution  of  the  inverse  dynamics  problem 

discretize  the  deformable  body  t.  This  matrix  equation  can  be  solved  using  matrix  and 
computer  methods  for  the  reference  motion  and  the  elastic  nodal  coordinate  of  the  ele¬ 
ments.  This  formulation,  therefore,  should  not  be  viewed  as  a  component  mode  type  of 
formulation.  In  a  component  mode  formulation,  the  deformable  body  can  be  treated  as 
one  element  whose  deformation  is  described  using  a  set  of  assumed  modes.  The  differences 
between  the  finite  element  formulation  and  the  assumed  mode  technique  and  the  difference 
between  the  obtained  invariants  of  motion  in  both  cases  must  be  clear.  Component  modes, 
however,  can  be  used  in  a  finite  element  formulation  in  order  to  reduce  the  number  of  elastic 
coordinates  and  eliminate  insignificant  high  frequency  modes.  To  this  end,  a  set  of  assumed 
modes  that  can  be  determined  by  solving  an  eigenvalue  problem  or  can  be  determined  us¬ 
ing  expertmental  modal  analyeis  techniques  may  be  used.  Let  B|„  be  the  modal  matrix 
that  contains  a  set  of  assumed  modu  that  are  determined  experimentally  or  by  solving  the 
eigenvalue  problem.  A  change  from  the  space  of  the  physical  nodal  coordinates  to  the  space 
of  modal  coordinates  can  be  achieved  by  using  th*  modal  transformation  B{„.  In  this  case, 
one  must  realize  that  there  is  no  change  in  the  structure  of  Eq.  16;  one  only  has  to  express 
the  invariants  of  Eq.  19  in  their  modal  form.  These  invariants  can  be  transformed  to  their 
modal  form  according  to 

=  r.B;,,  (22) 

|n,|  =  (23) 

That  is.  the  formulation  remains  the  same  and  any  change  in  the  basis  of  the  elastic  nodal 
coordinates  can  be  achieved  by  transformmg  the  invariants  of  motion.  Different  sets  of 


385 


i 


Figure  4.  Truiiverse  deformftcion  of  the  mdpomt  of  the  connecting  rod  using  diiferent 
boundary  conditions 


modes  obtained  using  different  sets  of  boundary  conditions  may  lead  to  the  same  solution 
provided  that  linear  combination  of  the  modes  produce  similar  shapes.  Figure  4  shows  the 
transverse  deformation  of  the  midpoint  of  the  connecting  rod  of  the  slider  cranlt  mechanism 
shown  in  Fig.  2.  The  results  presented  in  this  figure  are  obtained  using  two  different  sett 
of  boundary  conditions.  In  the  iirtt  cate,  mode  shapes  of  the  connecting  rod  are  obtained 
using  simply  supported  boundary  conditions  while  in  the  second  cate  the  mode  shapes  are 
obtained  using  a  body  fixed  coordinate  system  whose  origin  is  rigidly  attached  to  the  center 
cf  the  connecting  rod. 

The  fact  that  the  nonlinear  dynamic  equations  of  the  deformable  bodies  that  undergo 
large  displacements  can  be  expressed  in  terms  of  a  set  of  invariants  of  motion  suggests  a 
twostage  computational  strategy.  In  the  fint  stage,  the  invariants  of  motion  as  well  as  the 
conventional  stif&iess  matrix  are  evaluated  in  a  preproceuor  computer  program.  This  pro¬ 
gram  systematically  constructs  the  invariants  and  stiffiiess  matrices  of  the  finite  elements  of 
each  deformable  body  in  the  multibody  system.  These  element  matrices  are  then  assembled 
in  order  to  obtain  the  matrices  of  the  deformable  bodies  in  the  system.  If  the  modal  coor¬ 
dinates  are  to  be  used  to  reduce  the  number  of  coordinates  of  some  deformable  bodies  in 
the  system,  the  invariants  as  well  as  the  stif&ess  matrices  of  these  bodies  can  be  expressed 
in  their  modal  form  in  the  preprocessor  computer  program.  The  output  of  the  preprocessor 
is  a  set  of  data  that  remain  constant  throughout  the  motion  of  the  bodies.  These  data 
are  used  as  part  of  the  input  data  to  the  main  proceesor  used  lot  the  d3mamic  simulation. 
The  computational  algorithm  of  the  processor  can  be  based  on  either  the  augmented 
or  the  recuruve  formulation.  The  same  preprocessor  can  be  lued  in  both  cases  smce  the 
invariants  of  motion  are  characteristics  of  the  deformable  body  and  they  do  not  depend  on 
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the  approach  used  for  formulating  the  dynamic  equations  of  the  multibody  system. 

7.  Augmented  Formulation 

In  the  augmemed  formulation,  the  dynamic  equations  of  the  flexible  multibody  system  it 
formulated  in  temu  of  a  set  of  redundant  coordinates.  The  relationships  between  these 
coordinates  are  formulated  using  a  set  of  nonlinear  algebraic  constraint  equations  that  de¬ 
scribe  mechanical  joints  and  the  speciiied  motion  trajectories  in  the  multibody  system. 
These  kinematic  constraint  equations  can  be  introduced  to  the  dynamic  formulation  using 
the  vector  of  kinematic  constraint  equations  which  can  be  written  compactly  as 

C(q,t)  =  0  (24) 

wtiere  C  is  the  vector  of  the  kinematic  constraint  equations  that  can  be  linear  or  nonlinear 
function  of  the  system  generalized  coordinate  q  and  time  t.  In  the  augmented  formulation, 
the  equations  of  motion  can  be  written  compactly  u 

Mq  1-  cJa  =  Q,  +  P  (25) 

where  M  is  the  system  mass  matrix,  Cq  is  the  Jacobian  matrix  of  the  kinematic  constraints, 
X  is  the  vector  of  Lagrange  multiplicn,  Qr  is  the  vector  of  externally  applied  and  elastic 
forces,  and  F  is  the  vector  of  Coriolis  and  centrifugal  forces. 

7.1.  COMPUTER  FORMULATION  OP  THE  JOINT  CONSTRAINTS 

Figure  5  shows  examples  of  some  of  the  mechanical  joints  that  are  often  encountered  in 
several  industrial  and  technological  applications.  The  spherical  joint  shown  in  Fig.  5a  hu 
three  degrees  of  freedom  which  allow,  three  independent  relative  rotations  between  the  two 
bodies  connected  by  this  joint.  The  cylindrical  joint  shown  in  Fig.  5b  has  two  degrees  of 
freedom  since  it  allows  relative  translation  along,  and  relative  rotation  about  the  joint  axis. 
The  revolute  and  prismatic  joints  shown,  respectively,  in  Figs.  5c  and  5d  have  only  one 
degree  of  freedom.  The  mathematical  formulation  of  these  joints  can  be  expressed  in  the 
form  of  Eq.  24.  For  example  in  the  case  of  the  spherical  joint  we  require  that  two  points 
on  body  s'  and  body  j,  which  are  connected  by  this  joint,  remain  in  contact  throughout 
the  motion  of  the  two  bodies.  In  terms  of  the  absolute  coordinates,  thi'  condition  can  be 
expressed  in  the  form  of  Eq.  24  as 


where  superscripts  i  and  j  refer,  respectively,  to  bodies  t  and  j  and  H),  and  u'j.  are  the 
local  position  vectors  of  the  joint  definition  points  on  body  t  and  body  ;,  respectively.  The 
vectors  Hi'p  and  a{.,  in  flexible  body  dynamics,  are  implicit  functions  of  time  since  they 
depend  on  the  deformation  of  the  bodies. 

In  order  to  be  able  to  formulate  the  kinematic  constraints  that  describe  the  cylindrical, 
revolute  and  prismatic  joints  in  flexible  body  dynamics  a  set  of  intermediate  body  fixed 
joint  coordinate  systems  rrmst  be  introduced.  Figim  6  shows  body  t  and  body  j  that  are 
connected  by  a  cylindrical  joint  that  allows  relative  translation  ano  rotation  between  the 
two  bodies.  Let  X*  Y'  Z'  and  Xf  V  be  the  cootdiiiate  syetem  of  body  i  and  body  j, 
respKtivcly.  For  the  convenience  of  dcKribing  the  large  relative  displacements  between  the 
two  bodies,  the  intermediate  body  fixed  coordiiutie  systeihs  X'p  Yp  Z'p  and  Xj>  Zp 
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Figure  3.  Joint  conitraintt 


are  introduced.  Theie  coordinate  lystenu  are  «*«inTii>d  to  have  zero  maat  and  inertia  and 
their  origini  are  aiiumed,  in  the  finite  element  fonnuiation,  to  be  rigidly,  attached  to  nodal 
ooints  oh  the  two  bodies.  The  relative  motion  between  the  two  bodies  is  assumed  to  be 
tlong  the  joint  axis.  We  make  the  assumption  that  the  joint  axis  can  be  described  by  a 
riftid  line.  Let  h*  be  a  vector  drawn  on  body  t  along  the  joint  axis.  Similarly,  let  h‘'  be  a 
vector  drawn  on  body  j  along  the  joint  axis  u  shown  in  Fig.  6.  As  shown  in  the  figure,  the 
vector  s*-'  hu  a  variable  magnitude  since  it  connects  points  P'  and  P>  on  bodies  t  and 
respectively.  The  kinematic  constraint  equations  for  the  cylindrical  joint  can  be  written  as 


h‘  X  =  0  1 
h'  X  s‘>  =  0  j 


(27) 


where 


t‘>  =  a*  T  A*  ttj,  -  a^  -  A'  oj, 
h‘  =  A*  A*p  fi* 

V  A-*  Aj,  y 

in  which  fi*  and  fi’  are  constant  vectors  defined  in  the  intermediate  body  fixed  joint  coordi¬ 
nate  systems  Xp  Y},  Z*p  and  Xp  Zj,,  respectively,  A'p  and  A^  are  the  transformation 
matrices  from  the  imerradiate  coordinate  systems  to  the  body  coordinate  system.  If  the 
d^n^mn  ^b'oeUM  s  a^  y.arc  assumed  to  be  sm^  Aji  and  A^  are  in^tasunal  rotation 
maimM  that,eu'be.e^ptested  in.  terms  of  thtislopsi  sf'  t)it‘nbdal  poihts.  The  constraint 
equatiour.df 'Eqs.  29.  and  W  haye.oidy  fm»  indspikBdaat-  algebraic  equations  which  are 
honliheid  in  the  reference  and  eiastic  coordinates  iof  the  two  bodies. 


during  the  d)naauc  simulation*. 

7.2.  SOLUTION  FOR  THE  ACCELERATIONS 

Equations  24  and  25  represent  a  system  of  algebrsuc  and  difTerentiai  equations  which  cac-be 
solved  using  computer  and  numerical  methods.  In  order  to  be  able  to  numerically  integrate 
this  system,  Eqs.  24  and  25  must  be  solved  for  the  vector  of  accelerations.  To  this  end,  Eq. 
24  is  diiferentiated  twice  with  respect  to  time.  This  leads  to 

C,q  =  Q=  (30) 

where  Q,..  is  a  vector  that  absorbs  terms  that  are  quadratic  in  the  velocities.  If  Eqs.  25  and 
30  are  combined  one  obtains  a  system  of  matrix  equation  that  is  linear  in  the  vectors  of 
accelerations  and  Lagrange  multipliers.  This  matrix  equation  can  be  written  as 


M 

'■'q 

q 

Q«  +  F 

.c. 

0 

A 

This  system  of  equatiotu  can  be  solved  for  the  generalised  reference  and  elastic  accelerations 
as  well  u  the  vector  of  Lagrange  multipliers.  The  obtained  solution  contams  both  the 
dependent  and  independent  acederations.  Lagrange  multipliers  can  be  lued  to  determine 
the  generalised  forces  of  the  joint  constraints  and  specified  trajectories. 

Another  alternate  approach,  but  numerically  different,  it  to  use  the  generalized  coordi¬ 
nate  partitioning.  In  this  case,  the  vector  of  system  generalised  coordinates  can  be  written 
at 


where  q,  is  the  vector  of  system  independent  coordinates,  and  qj  is  the  vector  of  dependent 
coordinates.  According  to  this  coordinate  partitioning,  £q.  30  can  be  written  as 

Cq,  ^  +  Cq^  =  Qr  (33) 

where  Cq,  and  Cq^  are  the  sub-Jacobians  associated  with  the  independent  and  dependent 
coordinates,  respectively.  The  matrix  Cq^  is  a  square  matrix  and  if  the  kinematic  con¬ 
straint  equations  are  assumed  to  be  linearly  independent,  the  dependent  coordinates  can 
be  selected  such  that  the  matrix  Cq^  in  noasinguiar.  W^age  uMd  the  LU  factorisation 
method  to  identify  the  independent  coordinates.  Other  techniques  such  at  the  singular 
value  decomporition  and  the  QB.  method  that  involves  Householder  iterattons  were  alto 
proposed.  Equation  33  can  then  be  used  to  write  the  dependent  coordinates  in  terms  of  the 
independent  ones.  In  this  cate  one  has 

qi  =  B.,.qi  C-j  Q.: 


in  which 

B,ii  =  -  Cqj  Cq, 

Therefore,  the  total  vector  of  system  accelerations  can  be  written  in  terms  of  the  independent 
accelerations  as 

q  =  [  ?  j  =  C,,.qi  -h  Q,  (34) 
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where 


0 


Subitituting  £q.  34  into  £q.  25,  premultiplying  by  the  tranipote  of  the  matrix  C,^„  and 
uiing  the  fact  that  =  0,  the  vector  of  Lagrange  multipliers  can  be  eliminated  form 

£q.  25.  This  leads  to  the  reduced  system  of  equations 

Mi.qi  =  tt,  (35) 

where  M is  the  generalised  mass  matrix  associated  with  the  independent  coordinates  and 
it  the  vector  of  generalised  forces  associated  with  those  coordimues. 

The  use  of  the  embedding  technique  that  leads  -to  Eq.  35  is  not  computationally  as 
efficient  as  the  use  of  Eq.  31  to  solve  for  the  acceleratiosu.  For  this  reason,  Eq.  31  it 
used  with  sparse  matrix  techniques  in  lemal  commercially  available  multibody  computer 
programs. 
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9.  Recursive  and  Projection  Methods 


Ift  the  preced^  section,  the  use  of  the  augmented  formulation  in  the  computer  aided 
analysis  of  flexible  multibody  systems  is  discuned.  In  this  type  of  formulation,  the  kinematic 
and  dynamic  equations  are  formulated  in  terms  of  a  mixed  set  of  dependent  and  independent 
coordinates.  In  this  case,  one  may  introduce  Lagrange  multipliers,  or  use  the  embedding 
technique  to  reduce  the  number  of  dynamic  equations  to  a  wimirrmm  Mt.  In  this  section, 
other  alternate  approaches  that  can  be  used  in  the  analysis  of  flexible  muJtibody  systems  are 
discussed.  In  these  approaches  the  system  kinematic  a^  dynamic  equations  are  formulated 
in  terms  of  the  system  joint  degrees  of  freedom.  If  two  bodies  are  connected  by  a  joint,  the 
coordinates  of  one  body  can  be  expressed  in  terms  of  the  coordinates  of  the  other  body  as 
well  as  the  joint  degrees  of  freedom.  Using  these  displacement  relationships,  the  velocity 
and  acceleration  equations  can  be  .obtained  by  direa  diflTerentiation.  For  example,  if  two 
bodies  are  cotuuct^  by  a  cylindrical  joint  as  shown  in  Fig.  7,  the  relationship  between  the 
reference  and  elastic  accelekitti^  of  body  i  and  the  re&race  and  elastic  accelerations  of 
body  j  and  the  joint  .accelerations  cube  srrhten  u 

q<  =  G*q»’  +  H*F  +  7‘  (3B) 

where  G*  ud  H*  are  velocity  influence  cocfficiut  matrices  that  depend  on  the  coordinates 
>of  the  two  bodies,  7'  is  a  vector  that  absorbs  terms  that  are  qoadmic  in  the  velocities,  q’ 
ud  are  the  vectors  of  rrference  uiteUatic  accelcnitions  of  bodies  i  ud  j,  respectively, 
ud  P*  is  the  vector  of  the  jcut  and  elastic  accdcnttioqs  of  body  t.  In  the  case  of  the 
epnsfrained  motion,  the  gmeratised  NewUm-Euler  equations  of  Eq.  16  cu  be  writtu  for 
the  deformable  body  t  as 

"  M*?  =  Ql  +  Qi  +  Q),  (37) 

where  M‘  is  the^mass  matrix,  Q*  is  the  vector  of  externally  applied  ud  elastic  forces  and 
reution  forces  and  momenu,  Q).  is  the  vector  of  Coriolis  and  centrifugal  force  components, 
ud  Qn  is  the  vector  of  reaction  forces  ud  moments.  .Equation  38  cu  be  used  to  eliminate 
the  r^uce  ud  elutic  accelerations  of  body  t  frostt  Eq..37.  This  leads  to  a  set  of  dynamic 
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cquationi  of  body  i  er^mted  in  termi  of  the  reference  and  elutic  acceleration!  of  body 
j  and  the  joir  accelerations.  Furthermore,  in  these  equations,  the  joint  reaction  forces 
between  the  twe  bodies  ^re  automatically  eliminated.  This  procedure  can  be  contmued 
from  jne  body  'o  ano;her  until  the  base  body  is  reached,  leading  to  a  system  of  dynamic 
equr.tions  expresced  in  terms  of  the  degrees  of  &r.*dom. 

h'ott  exii:bg  recursive  methods  lead  to  small  systems  of  strongly  coupled  equations. 
Thi*  ccefident  matrix  of  the  acceleration  equation  is  danse  and  nonlhaear  u  the  result  of 
thi  ‘^.,,e  relative  displacement  between  the  interconnected  bodies.  Decoupling  the  joint 
and  elastic  accelerauons  in  .these  equations  will  require  finding  the  inverse  or  the  LU  fac¬ 
torisation  of  ao;il':  fn  .\.ntriew.i  whose  dimension  dependv  on  the  number  of  elastic  degreee 
of  freed  .'  in.  Consequently  speaking  of  the  order  of  an  alsvcithm  becomes  meaningless  since 
the  number  of  elastic  coordinates  varies  from  one  body  to  another.  Recently,  a  recuriive 
method  that  systematically  decouple  the  joint  and^eUttic  accelerations  wu  proposed.  In 
this  method,  the  generalist  Ncwton-Eular  equatiou,  the  relationship  betwaen  tha  abso¬ 
lute,  elastic  and  joint  aceeleratioiu,  and  thh  reaction  force  equations  are  combined  in  order 
to  form  a  system  of  looesly  coupled  equatiohr  winch  hw  a  sparse  matrix  structure.  By 
using  matrix  partitioning,'  the  coupling  betwaien  tha  joint  and  elastic  acctlarations  can  be 
elimhiated.  This  leads  to  smallar  system  of  equations  ctpntsed  in  terms  of  the  joint  accel¬ 
erations  and  joint  reaction  forces.  The  dimensipn  of  the  coefficient  matrix  in  this  system 
is  independent  of  the  number  of  elastic  coordinates.  This  procedure  can  be  demonstrated 
by  utilising  £q.  36  to  write  the  absqiute  and  elutic  aecaletations  in  temu  of  the  joint  and 
L-lastic  Mcelentions  u 
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where  subicriptt  r  end  /  refer,  teipectively,  to  the  ebiolute  reference  end  elutic  coordinetei, 
Pr  it  the  vector  of  lystem  joint  coordinetet,  tLm  e^d  fi/>/  ere  velocity  influence  coefficient 
metricei,  end  7,  it  e  vector  thet  ebiorbt  termt  which  ere  quedretie  in  the  veloeitiei. 

The  equetioni  of  motion  of  the  flexible  multibody  system  expreiied  in  terms  of  the 
ebtolute  coordinetet  cen  be  written  et 

Mq  =  Q  +  P  (39) 

whore  M  it  the  system  mus  metrix,  q  it  the  vector  of  ebtolute  ecceleretiont,  Q  it  the 
vector  of  forces  thet  ebtorbt  epplied,  centrifugel,  Coriolis  end  elettic  forces,  end  F  it  the 
vector  of  joint  reection  forces.  Equetibn  39  cen  elso  be  written  u 


where,  as  previously  pointed  out,  subscripts  r  end  /  refer,  respectively,  to  the  rigid  body 
end  elutic  coordinetet. 

The  joint  reection  forces  mutt  satisfy  the  identity 


end  consequently 

aJrFr  =  0  (42) 

P/  =  -  Ap/Pr  (43) 

These  equetioni  show  thet  the  joint  forces  usocieted  with  the  elutic  coordinetet  do  not 
introduce  new  independent  verieblet.  Thue  forcu  can  be  determined  by  using  the  joint 
forces  usocieted  with  the  reference  coordinates. 

Substituting  Eq.  43  into  Eq.  40,  one  obtains 

M„q,  +  M,,q/  =  Q,  +  F,  (44) 


M/,q,  +  M//q/  =  Q/  -  fl^yP,  (46) 

The  first  metrix  equation  in  Eq.  38  cen  be  written  u 

qr  =  fippPr  4-  Sp/q/  +  7,  (46) 

Combiimg  Eqs.  42, 44, 45,  end  46,  one  obtiins 
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This  system  of  equations  hu  e  dimension  equal  to  12n  n/  r  n,  where  n  it  the  total 
number  of  bodies,  n/  is  the  total  number  of  elastic  degteu  of  freedom,  end  Ur  is  the  total 


number  of  joint  coordinatei.  The  coefficient  muruc  in  Eq.  47  ii  lymmetric  and  iparte. 
Thii  tyicem  can  be  lolved  in  order  to  obtain  the  abiolute,  joint  and  elaitic  accelerations  as 
well  u  the  joint  reaction  forces.  Note  that  the  joint  and  elutic  accelerations  are  coupled 
in  this  equation.  If  the  number  of  elastic  degrees  of  freedom  is  large,  the  solution  of  Eq.  4? 
at  every  time  step  can  be  computationally  expensive.  The  joint  and  elastic  accelerations 
can,  however,  be  decoupled  leading  to  a  smaller  system  of  equations  whose  dimension  is 
independent  of  the  number  of  elastic  degrees  of  freedom.  To  this  end,  one  can  utilise  the 
fact  that  the  matrix  M//  it  a  constant  positive  definite  matrix.  This  it  usually  the  cue 
when  a  consistent  mau  fonnulation  it  used  or  when  the  modal  coordinates  ue  employed. 
Using  M//  u  the  pivot  element  in  Eq.  47,  one  can  use  a  simple  Gaust>Jordan  elimination 
procedure  to  obtain  the  following  reduced  system  of  equations 


■  (m,,  -  m,/M7;m/,) 
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(i+M,/M7;fi5?y)  0 

-fi  pp 

-Ajp  0 
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-F, 
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Q,  -  MrfMjlCt, 
7r  +  9p/M7/Q/ 


0 


(48) 


The  dimension  of  this  system  of  equation  it  independent  of  the  number  of  elutic  coordinatu 
of  the  system.  Furthermore,  the  coefficient  matrix  remains  symmetric.  This  system  can 
be  solved  for  the  absolute  reference  and  joint  .accelwuiont  u  well  u  the  joint  reaction 
forces.  The  elutic  accelerations  can  then  be  obtained  by  solving  Eq.  45.  Since  M//  it 
a  constant  matrix,  the  solution  for  the  elutic  acceleration  is  trivial,  especially  in  the  cue 
of  using  the  modal  coordinatu  because  M//  it  a  diagonal  matrix  in  this  cue.  It  can  be 
shown  that  the  muricct  (M,,  -  Mf/Mj/M/r)  and  tLpi’M.’jjtL'pf  on  the  main  diagonal 
of  the  coefficient  murix  in  Eq.  48  ue  block  diagonal  nutrien.  Consequently,  a  recursive 
projection  procedure  which  hu  a  computational  ^vantage  ovu  existing  order  n  algorithms, 
because  it  it  independent  of  the  numbu  of  elutic  degreu  of  frudom  of  the  system,  can  be 
applied. 


9.  Linear  Theory  of  Elastodynamics 

The  dynamic  equations  of  flexible  multibody  systems  are  highly  nonlineu  because  of  the 
finite  rotation  of  the  deformable  body  reference.  A  solution  strategy  that  hu  been  u-.ed 
in  the  put  it  to  treat  the  mnitibody  system  first  u  a  collaetion  of  rigid  bodies.  General- 
purpose  multi-rigid-body  computer  programs  can  then  be  used  to  solve  for  the  inutia  and 
reution  forcu.  Thue  inertia  and.reution  forces  obtained  from  the  rigid  body  analysis 
ue  then  introduced  to  a  lineu  eluticity  problem  to  solve  for  the  deflection  of  the  bodies 
in  the  multibody  systems.  The  total  motion  of  a  body  is  thin  obtained  by  superimposing 
the  small  elutic  deformation  on  tbs  gross  rigid  body  motion.  This  approach  is  usually 
referred  to  u  the  itnedr  theory  of  elaetodynamice.  In  this  approach,  rigid  body  motion 
and  elutic  deformation  are  not  solved  for  simultaneously.  Furthermore,  the  effect  of  the 
elutic  deformation  on  the  rigid  body  motion  is  neglected.  This  usumption,  howevu,  may 
not  be  valid  when  high-spud,  Upweight  mechanical  systems  are  considsrrd.  The  effect 
of  the  coupling  between  the  elutic  daformuion  and  tlte.-gross  rigid  body  motion  may  be 
significant., 

.  In  oMu  to  imdustand.the  dynamic  formulation  based  on  ths.iineu  theory  of  elutody- 
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namics  we  write  the  equetiont  of  motion  of  the  deformable  body  in  the  following  partitioned 
form: 


■  M), 

M), 

j 

where  q‘  = 

[e-- 

0  0 

qi 

. 

-h 

0  K), 

. 

(49) 


ii  the  vector  of  reference  coordinate!  of  body  t,  subicripti 

r  and  /  refer,  reipectively,  to  reference  and  elastic  coordinates,  and  Q*  is  the  vector  of 
generalised  forces,  includi;^  the  external,  reaction,  Coriolis  and  centrifugal  forces.  Equation 
49  yields  the  following  two  matrix  equations: 


MJ,  q;  +  Ml,  q)  =  Q; 


(50) 


M),  qi  +  M),  q>  +  K),  q)  =  <k‘,  (51) 

In  the  linear  theory  of  elastodynamics,  the  term  M).yqy  in  Eq.  50  is  neglected.  Furthermore, 
the  matrix  M*,  and  the  vector  Q*  are  assumed  not  to  depend  on  the  elastic  deformation 
of  the  body.  Using  these  usumptions,  one  can  write  Eqs.  50  and :  i  as 

(52) 


M>;q)  +  K),q)  =  Q)  -  M>,q; 


(53) 


Figure  8.  Tracked  vehicle 


Equation  52  can  be  lolved  for  the  reference  coordinate!,  velocitiei,  and  accelerations  uiina 
rigid  multibody  computer  program!.  The  information  obtained  from  solving  Eq.  52  can 
then  be  iubatituted  into  Eq.  S3  in  order  to  obtain  a  linear  structural  problem.  Equation  53 

can  then  be  solved  for  the  vector  by  using  any  of  the  existing  linear  structural  dynamics 
programs. 

The  linear  theory  of  elutodynamics  remains  a  viable  approach  in  the  dynamic  anaivsis 
of  many  mechamcal  system  appUcations.  An  example  of  these  applications  is  tracked  vehi- 
cles  M  the  oat  shown  in  Fig.  8.  A  two  dimensional  planar  model  of  this  vehicle  is  shown 
m  Fig.  9.  The  deformation  mode  of  the  chassU  of  the  vehicle  are  of  low  frequencv  and 
consequently  mcluding  the  inertia  coupling  between  these  vibration  modes  of  the  i-h.t.ip 

. ’  ■  of  vehicle  in  the  dynamic  model  does  not  lead  to  numerical 

;  rojirms  Th<«  nack  links  on  the  other  hand  are  very  stiff  and  consequently  the  use  of  the 
vib''ai.on  moc.«.  of  the  track  links  in  the  nonlinear  dynamics  leads  to  numerical  difficulties 
mtegration  of  the  system  equations  of  motion.  In  this  cue,  the  stresses  in  the  track  links 
c  m  be  efficiently  predicted  using  the  linear  theory  of  elasiodynamics. 


Figure  9.  Two  dimensional  model 
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ABSTRACT.  This  article  presents  a  kinematic  approach  to  the  modelling  and  the  motion  specifica¬ 
tion  of  robotic  manipulation  tasks  in  which  the  manipulated  object  is  constrained  by  conucts.  The 
presented  approach  takes  into  account  complex  and  time  varying  motion  constraints,  and  is  very 
appropriate  to  be  integrated  into  CAD  based  task  planning  and  control. 

The  description  of  the  interacdon  between  the  manipulated  object  and  other  objects  in  its 
environment  is  based  on  the  lint  and  second  order  approximations  of  their  geometry  around 
the  contact  areas.  From  these  geometric  descriptions,  the  manipulated  object’s  notnin^  motion 
freedom  and  its  dual,  the  set  of  possible  reaction  forces,  ate  then  modelled  using  the  similarity  with 
the  kinetostadcs  of  kinematic  chains.. 

The  kinematic  approach  is  iilustn>ted  with  the  important  example  of  the  classical  peg-in-hole 
problem.  The  approach  offers  new  to%>lr.  to  rr’dably  model  and  specify  the  insertion  motion  of  the 
peg,  even  in  the  case  of  vety  large  misalipm<!;ts  between  the  axes  of  peg  and  hole. 


1  Introduction 

Robotic  manipulation  tasks  very  often  involve  contacts  between  the  object  att...'ced  to  the 
manipulator  (called  the  manipulated  object,  or  "MO"  for  short)  with  other  objects  in  its  environment 
(call^  “ENV"  for  short).  In  many  caw,  the  presence  of  contacts  is  indispensable  for  the  execution 
of  the  manipulation,  since  1)  the  contacts  belong  to  the  goal  position  of  the  MO,  or  2)  during  the 
motion  they  reduce  (part  of)  the  inevitable  uiicenainties  between  the  relative  positions  of  MO  and 
ENV.  However,  the  conuct  interactions  limit  the  motion  freedom  of  the  manipulated  object,  and 
generate  contact  forces.  Hence,  the  maiiipulamf  nMds  sonie  active  or  passive  means  to  react  safely 
to  these  forces,  arid  at  the  same  time  to  continue  the  desued  manipulation  action.  Anyway,  both 
the  active  and  pusive  approaches  (i.e.,  force  control,  respectively  compliance  at  the  end  effector) 
can  dealdnly  with'limited  inaccuracies  between  the  desh^  nominal  motion  of  the  MO  on  the  one 
hand,  arid  the  real  rhdtion  freedom  of  the  MO. as  allowed  by  the  ENV  on  the  other  hand.  Therefore, 
a  good  nominal  specificaiion  of  the  desired  niotion  reinaihs  indispenabie. 

For  the  traditional  robotic  m^ipui'atioh  tasks,  thjs  speciheation  relies  on  the  human  pro^m- 
mer’s  implicit  mental  model  of  the  AfO’s  motion  ^edom.  However,  if  the  motion  constraints 
become  niore  cotnpiex,  or  if  the  task  specification  has  to  be  generated  by  an  automatic  planning 
system,  more  explicit  models  are  required,  as  well  as  a  systematic,  computer  assisted  approach. 
Geometric  models  aie  the  appropriate  building  blocks  with  which  to  construct  a  computer  mded 
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task  specification  system  for  constrained  robotic  manipulation  tasks:  the  description  of  the  surfaces 
of  MO  and  ENV  around  the  contact  areas  determines  the  type  of  the  contacts,  as  well  as  -up  to 
non-ideal  effects-  the  corresponding  motion  freedom  of  the  manipulated  object. 

The  intensely  snidied  peg-in-hole  task  is  a  prime  example  of  the  difficulties  which  occur  in 
the  motion  specification  of  a  manipulation  task.  Fig.  i:  most  references,  (followmg  Whimey’s 
seminal  paper,  (19P2))  only  discuss  active  or  passive  means  to  further  insert  the  peg  mto  the  hole 
after  an  initial  small  insertion  has  already  been  established;  the  main  problem  is  then  to  avoid 
extraneous  forces,  wedging  and  jamming.  However,  the  question  of  how  to  reach  this  initial 
position  is  neglected.  The  kinematic  approach  presented  in  this  paper  offers  a  (partial)  solution  to 
this  problem:  once  the  bottom  of  the  peg  has  made  contact  with  the  rim  of  the  hole,  a  systematic 
method  is  presented  to  align  the  axes  of  peg  and  hole,  even  if  the  initial  misalignment  is  very  large. 
The  same  ideas  are  applicable  to  a  wide  range  of  motion  constraints  on  the  manipulated  object. 


Figure  1:  Peg-in-hole.  If  the  axes  of  the  peg  and  the  hole  are  very  badly  aligned,  it  is  not 
straightforward  to  specify  the  desired  motion  of  the  peg,  especially  since  its  instantaneous  motion 
heedom  is  continuously  changing  during  the  task. 

Force  control  (also  called  compliant  motion)  is  undoubtedly  the  most  intensely  studied  part 
of  the  constrained  manipulation  problem.  This  coiild  give  the  impression  that  modelling  and 
speciheatipn  are  trivial.  Maybe  this  is  the  case  for  vefy  simple  force  controlled  tasks,  as  described 
by  M^on  (1981)  and  De  Schutter  and  vari  Bnissei  (i988)V  peg  iii  hole  (with  partly  inserted  peg), 
following  a  surface  with  a  point  contact,  opening  a  dooh  hiniihg  a  cnuik  or  a  screw, . . . 

These  simple,  or  elementary,  compliant  tasks  can  s^fied  with  the  task  frame  or  compliance 
yrome  approach,  De.Schutter  and’Van  Briisxl  (1988).  usk  f^e  with  its  natural  constraint 
directions  krves  as  a  geometric  model  of  the  thotioh  constiwt;  And  indeed,  for  uukswith  a  simple 
contact  geometry  the  relation  between  this  contact  geobetry^  the  force  controlled  directions  (i.e. 
the  n^rb  constraint  directions)  arid  the  velocify  cphtbll]^  dinCidons  (i.e.  the  artificial  constraint 
directions)  in  die  task  frame  is  quite  straightforward  andintuirively  clear. 

Howeyer^this  is  not  the  case  for  tasks  wib complex  mebbriConstniints.  A  motion  constat  is 
complexjf  ii  is  the  combination  of  several  sitnpie,  or  eibine^ry,  ebnsmaints,  and  if  bis  combitiation 
is  time  iiaiyJng.j'Se^  FiSi  2  for  an  exaihj^le.  Time  vari'i^  iheaniCthat  the  relative  loc^ons  of  some 
of  the  elementaryc.9nstrw  change  during  the  executioh  of  the  tuk.  see  the  peg-iit-hole  example. 

This  papef  prebhts  a  model  bored  comproniise  between  dff  line  modelling  cost,  on  line  mod- 
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elling  accuracy,  and  flexibility  in  the  task  specification:  the  compliant  motion  task  relies  on  simple 
off  line  models  of  (a  combinauon  of)  elementary  motion  constraints;  these  models  are  easily 
adaptable  on  line  and  they  allow  a  user  friendly  task  specification. 

Other  authors  have  already  presented  model  based  approaches  to  cope  with  motion  constramts. 
Montana  (1988)  describes  the  kinematics  of  griping  objects  with  robotic  fingers  equipped  with 
tactile  sensors.  Cai  and  Roth  (1986,  1988)  give  a  very  thorough  and  complete  description  of 
the  nominal  kinematics  for  the  relative  motion  of  objects  under  point  and  line  conucts.  These 
approaches  are  of  a  much  higher  complexity  than  the  one  presented  here.  Moreover,  they  are  more 
difficult  to  use  on  line,  and  not  well  suited  for  complex  motion  constraints. 


Figure  2:  Complex,  rime-varying  morion  constramts.  Left:  moving  a  block  subjected  to  two  or 
three  simultaneous  contacts  poses  motion  specification  problems  if  the  goal  situation  is  a  non- 
equilibrium  position.  Right;  a  vertex-face  comactat  the  left  side  of  the  MO,  plus  i  face-face  contact 
at  its  bottom. 

Motion  constraint  models  exist  on  different  levels  of  abstraction,  and  for  a  wide  variety  of 
applications.  On  the  highest  level  the  motion  constraint  is  descried  as  a  list  of  elementary  contacts, 
which  act  simultaneously  on  the  manipulated  object  This  is  the  topological  or  symbolical  model 
of  the  constraint  It  contains  the  type  of  each  elementary  constraint  ana  a  pointer  to  the  geometnc 
entities  (face,  edge,  vertex,  surface,  . . . )  involved.  This  level  of  motion  constraint  models  is 
generally  used  in  off  line,  CAD  based  task  planners  for  compliant  motions,  or fine  morions,  as  they 
are  often  ci^ed  in  this  context  The  vocabulary  of  element^  contacu  used  at  this  level  is  rather 
uniform;  vertex-surface,  edge-edge,  etc.  Buckley  (1989)  and  Lauder  (1989)  deal  with  the  problem 
of  automatically  generating  sequences  of  compliant  actions  to  reach  a  user  specified  go^.  Xiao 
and  Volz  (1989),  Xiao  (1992)  and  Desai  and  Volz  (1989)  also  started  to  examine  how  to  verify 
the  current  mption  constraint  and  replan  the  task  whenever  a  deviation  from  the  nominal  plan  is 
detected  at  execution  time.  The  common  limitation  to  all  mentidhed  planners  is  that  they  offer 
no  interface  to  an  on  line  task  controller  their  plans  are  expressed  as  sets  of  elementary  motion 
constraints,  together  with  a  purely  geometric  sp^ificatipn  of  the  motion.  Moreover,  this  motion 
specification  invariably  uses  6nly  a  very  limited  subset  of  the  total  available  motion  ^edom;  pure 
translations  or  pure  rotations. 

This  paper  covets  the  modelling  and  motion  specification  aspecu  of  constrained  manipulation, 
within  the  framework  of  kinematics  of  complex  chains,  Angeles  ( 1988).  To  this  end,  each  elemen¬ 
tary  contact  is  replaced  by  an  equiv^em  kinematic  chain,  called  a  virtual  (contact)  manipulator. 
The  topology  of  the  chain  is  given  by  the  type  of  the  contact:  the  local  surface  geometry  around  the 
contacts  determines  the  numerical  description  of  the  chain;  link  lengths,  current  “joint"  values  and 
limits,  etc.  Simplicity  of  the  models  is  emphasized,  because; 

1 .  The  user  interface  of  the  computer  assisted  motion  specification  system  must  remain  simple. 
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2.  Exact  modelling  is  practically  impossible,  or  too  costly.  ; 

3.  It  is  assumed  that  the  manipulator  has  some  active  or  passive  robustness  against  small 
uncertainties  in  the  generated  motion  specification. 

The  kinematic  approach  permits  the  use  of  well-established  tools,  terminology  and  algorithms  from 
kinematics:  revolute  and  prismatic  joints,  twisB  and  wrenches,  Jacobian  matnces,  etc. 

Local  geometric  models  exist  at  different  levels  of  detail: 

1.  First  order,  or  polyhedral:  the  position  of  the  contact  point  and  the  direction  of  the  contact 
normal. 

2.  Second  order,  i.e.,  the  first  order  description,  plus  curvature  information  at  the  contact  point. 

3.  Higher  order.  This  level  is  not  discussed  in  this  text,  because  it  is  incompatible  with  the 
requirement  for  simplicity. 

Section  2  introduces  the  terminology  to  describe  motion  freedom  and  constraint  reaction  forces. 

This  is  followed  in  Section  3  by  the  kinematic  models  for  elementary  and  complex  motion  con¬ 
straints,  and  the  conespcmding  mathematical  representations.  Fmally,  Section  4  applies  this  theo¬ 
retical  framework  to  the  peg-in-hole  example. 


2  Motion  Constraints:  Concepts 

This  Section  elaborates  the  concept  of  elementaiy  motion  constraint,  which  appeared  already 
in  the  Introduction.  Then  follow  the  definitions  of  the  twist  and  wrench  systems  of  a  motion 
constraint  They  ate  the  basic  mathematical  representations  to  link  the  geometric  descriptions  of 
the  contacts  on  the  MO  to  motion  speci^cation  for  the  manipulating  robot  The  last  subsection 
explains  reciprocity,  i.e.,  the  physic^  du^ty  relationship  which  always  exists  between  the  wrench 
and  twist  systems  of  any  motion  constnunt 

2.1  ELEMENTARY  MOTION  CONSTRAINTS 


The  point  contact  (or  surface-surface  contact)  between  two  rigid  bodies  is  the  simplest  physical 
model  of  a  motion  constnwt  Strictly  speaking,  it  is  the  only  really  elementary  motion  constraint 
in  the  sense  that  all  other  motion  constrwtt  consist  of- a  (possibly  continuous  and  infinite)  set 
of  point  contacts.  However,  every  field  of  application  has  its  own  particular  set  of  “elementary” 
constraints,  i.e.  those  that  belong  to  the  standard  vocabulary  of.the  field,  and  that  are  assumed  to  be 
the  most  basic  and  simple  consoaints  needed  to  describe  aU  systems  in  the  field.  Some  examples: 


Assembly  The  polyhedral  contacts  (vertex-face,  edge-face,  edge-edge,  face-face),  or  the  mixed 
polyhedral-non-polyhedral  vertex-surface  contact  \face  is  a  planar  part  of  an  object;  a 
surface  is  curved.  An  edge  is  the  inter^tion  of  two  faces,  and  a  vertex  is  the  intersection  of 
two  or  more  edges. 

Robotic  hands  ^e  constraints  consist  of  soft  and  hard  finger  contacts,  with  sufficient  friction  to 
prohibit  slipping. 


Linka^  The  theory  of  machines  and  mechuisms  makes  use  of  all  types  of  joints.  The  revolute 
arid  prismatic  Joints  are  the  elementary  ones. 
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Elementary'  motion  constraints  ate  the  building  blocks  for  all  possible  motion  constraints  in  a 
particular  Held.  Such  a  combination  of  motion  constraints  is  called  a  composite  constraint.  This 
paper  reformulates  the  elementary  and  composite  motion  constraints  appearing  in  such  fields  of 
assembly  or  robotic  hands  as  linkages  of  prismatic  and  re  volute  joints. 

2.2  TWIST  AND  WRENCH  SYSTEMS 

To  specify  a  constrained  motion  task,  it  is  important  to  know  how  the  MO  can  move,  without 
breaking  the  desired  contacts,  and  without  generating  excessive  reaction  forces.  For  any  motion 
constraint  on  the  manipiiinti^ri  object,  either  elementary  or  composite,  mathematical  models  of  these 
sets  of  possible  motions  and  forces  are  given  by  the  following  two  vector  spaces: 

IVrist  system  This  is  the  vectorspaceofallinstantaneous  velocities,  orinfinitesimal displacements, 
that  the  MO  can  have  with  respect  to  the  ENV,  without  breaking  the  contact,  Lipkin  and  Duffy 
(1988).  A  twist  t  is  the  ordered  combination  of  an  angular  velocity  vector  ui  and  a  linear 
velocity  vector  v:  t  =  (<3,  The  notation  for  a  twist  system  is  T. 

Wrench  system  The  vector  space  dual  to  T  is  the  wrench  system  W  of  all  ideal  reaction  forces 
that  can  be  generated  in  the  contact  A  wrench  w  is  the  ordered  combination  of  a  force  vector 
f  and  a  moment  vector  tfi:  w  =  (f,  iS). 

TVist  and  wrenches  ate  Idnetostatic  applications  of  the  geometric  concept  of  a  screw,  i.e.,  the 
ordered  combination  of  a  Une  vector  and  a  free  vector,  Lipkin  and  Duffy  (1988). 

The  tact  that  T  and  TV  ate  vector  spaces  is  mathematically  ^pealing,  because  the  systems  ate 
totally  known  if  a  basis  for  them  is  known.  A  possible  drawback  is  the  local  validity  of  the  models; 
in  general,  TwAW  change  during  the  motion  of  the  MO.  It  is  also  important  to  realize  that: 

•  T  and  TV  ate  first  order  moitis,  since  they  only  describe  the  instantaneous  motion  freedom. 

•  T  contains  velocities  or  it^initesimal  displacements,  so  that  it  gives  no  information  about  the 
motion  freedom  of  the  MO  under fiiute  displacements. 

•  TV  contains  only  the  ideal  and  static  reaction  forces,  i.e.  no  friction,  elasticity  or  dynamic 
effects  are  modelled. 

For  elementary  motion  constraints  it  is  straightforward  to  describe  the  instantaneous  motion 
freedom  of  the  MO.  For  composite  constraints  the  modelling  is  mote  complicated.  However,  the 
following  procedure  leads  to  the  desired  lesulL' 

I .  Construct  the  T’s  and  TV's  of  the  composing  elementary  constraints. 

2a.  If  a  set  of  elementary  constraints  on  the  MO  act  in  parallel,  then  the  twist  system  of  the 
composite  constraint  is  the  vector  space  intersection  of  the  twist  systems  of  the  composing 
constraints.  The  wrench  system  is  the  vector  space  sum  of  the  wrench  systems  of  the 
composing  constraints.  Forimdly  one  writes: 

TP*’’ =T‘nTM.,. fir’s  TT^’’  =  TV‘  +  TV*  +  ...  +  TV’‘'.  (1) 

2b.  If  the  elementary  constraints  act  in  series,  the  abovementioned  relations  are  interchanged; 

T**' =  T' +T^  +  ...+r’S  TV*'’’  =  TV‘nTV^n...nTV'’'.  (2) 

Numerical  implementations  of  this  procedure  ate  supported  by  reliable  and  stable  algorithms,  based 
on  Singular  Value  Decomposition  of  the  matrices  representing  bases  for  T  and  TV.  Golub  and  Van 
Loan  (1989). 
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2.3  RECIPROCITY 


The  twist  system  T  and  the  wmnch  system  W  are  dual  vector  spaces.  In  a  strict  mathematical 
sense  this  means  that  to  each  wrench  wthere  conesponds  a  linear  form  R^{X)  over  the  space  of  twists 
t.  (A  linear  form  is  a  linear  mapping  from  a  vector  space  to  the  line  of  real  numbers.)  Similarly,  a 
linear  form  i2t(w)  over  the  space  of  reaction  forces  is  defined.  The  physical  interpretation  of  this 
linear  form  is  as  follows:  it  represents  the  virtual  power  that  the  motion  t  generates  against  the 
wrench  w: 

iZt(w)  =  i2w(t)  =  m  •  <3  +  f  •  V.  (3) 

If,  with  a  small  abuse  of  notation,  t  and  w  represent  also  the  coordinates  of  a  twist  and  a  wrench 
with  respect  to  a  reference  frame,  the  numerical  equivalent  of  Eq.  (3)  is: 


J?t(w)  =  Unit)  =  t, 


(4) 


with 


03x3  h^3 
,  hx3  03x3 


(5) 


For  compliant  manipulation  tasks,  the  motion  t  of  the  MO  does  not  break  the  contact  with  the  ENV, 
and  the  virtual  power  generated  against  the  ideal  reaction  wrench  w  vanishes.  One  says  that  t  and 
w  are  reciprocal: 

t  =5  iB  •  «3  +  f  •  V  »  0.  (6) 


This  reciprocity  condition  remains  valid  under  serial  and/or  parallel  composition  of  motion  con¬ 
straints. 

I 

3  Kinematic  Models  ^ 

k 

As  mentioned  before,  the  surface  geometry  of  the  contacting  rigid  bodies  determines  the  I 

resulting  motion  constraint,  because  of  the  mutual  impenetrability  of  the  bodies.  Hence,  this  ; 

Section  starts  with  a  simple  geometric  model  of  these  surfaces,  as  given  by  their  first  and  second 
order  differential  geometric  properties.  Second,  it  derives  the  relationsbip  between  this  geometric 
description  of  each  of  the  individual  objects,  and  the  features  of  their  interaction,  i.e.,  the  contact 
Third,  it  translates  the  concepts  of  motion  fre^m  and  constraint  into  equivalent  kinematic  models, 
and  finally  into  their  mathematical  representations.  Kinematic  modelling  of  motion  constraints  has 
the  following  advantages: 

•  Standard  terminology  and  algorithms  of  mechanisms  and  manipulators  are  available. 

•  There  exists  a  close  correspondence  between,  on  the  one  hand,  the  first  and  second  order 
geometry  of  a  motion  constraint,  and,  on  the  other  hand,  the  kinematic  model. 

•  Specification  of  the  desired  motion  of  the  MO  becomes  intuitive  and  yet  unambiguous:  it 
boils  down  to  deciding  which  are  the  driving  joints  in  the  kinematic  model,  and  what  are  their 
desired  speeds. 

The  kinematic  model  for  a  joint  constraint  is  trivial:  it  is  the  joint  itself.  For  a  contact  constraint  only 
the  reciprocal  motion  freedom  is  modelled,  i.e.  these  motions  allowed  by  the  contact  and  which  do 
not  break  the.contacL  This  is,  by  definidoii.  not  a  Ijmiting  assuinptidh  for  the  manipulation  tasks 
discus^  iri  tbis:text  Moreover,  it  elithinates  the  distinction  between  (the  models  of)  contact  and 
joint  consnaints. 
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3.1  DESCRIPTION  OF  LOCAL  GEOMETRY:  GEOMETRIC  FRAMES 

In  general,  the  surfaces  of  MO  and  ENV  contact  each  other  in  one  or  more  discrete  contact 
points.  For  each  of  these  points,  the  surface  of  both  objects  is  of  one  of  the  following  three  types:  a 
smooth  surface,  a  smooth  curve  or  a  vertex.  In  differential  geomeny,  the  local  geometry  of  a  surface 
or  a  curve  in  the  neighbourhood  of  a  point  is  characterized  by  an  orthogonal  reference  rfame: 

1.  Smooth  surface.  The  tangent  plane  (i.e.,  two  independent  tangent  vectors)  in  any  pomt  on 
the  surface  is  uniquely  defined  by  the  object’s  geometry.  An  orthogonal  reference  frame, 
the  so-called  principal  frame,  is  defined  as  follows,  O’Neill  (1966):  its  origin  lies  in  the 
contact  point,  one  axis  lies  along  the  normal  at  the  point,  and  the  two  other  axes  lie  along  the 
directions  of  minimum  and  maximum  curvature.  Ihese  are  called  the  principal  directions  of 
curvature,  and  ate  always  orthogonal  and  uniquely  defined,  unless  the  object  is  umbilic,  i.e. 
the  curvature  at  the  contact  point  is  equal  in  all  directions.  This  is  the  case  for  spheres  and 
planes. 

2.  Smooth  curve.  The  tangent  to  the  object  has  a  unique  merning  in  only  one  single  direction. 
Yet,  for  each  point  on  a  cur\  e,  an  orthogonal  reference  frame,  the  Frenet  frame,  is  defined: 
one  axis  along  the  tangent,  one  along  the  normal  (i.e.,  pointing  to  the  centre  of  the  osculating 
circle),  ^  the  third  one,  the  binormal  direction,  orthogonal  to  the  other  two.  The  Frenet 
frame  directions  are  uniquely  defined,  unless  the  curve  is  a  straight  line. 

3.  Vertex.  A  unique  definition  of  tangent  vector  or  tangent  plane  is  impossible. 

So,  in  a  contact  point,  each  of  MO  and  ENV  has  its  own  orthogonal  reference  frame,  which  is,  in 
general,  fully  determined  by  ibe  first  and  second  order  geometric  parameters  of  the  surface:  the 
tangents,  normals  and  directions  of  curvsuute.  The  fnunes  are  called  the  geometric  frames  at  the 
contact  point  and  denoted  by  {gto]  for  the  MO  and  {pec/}  for  the  ENV.  However,  the  geometric 
parameters  do  not  completely  determine  the  geometric  frames  in  the  case  of: 

•  Umbilic  surfaces:  the  tangent  plane  is  uniquely  defined,  but  not  the  principal  directions. 

•  Vertices  and  straight  lines:  the  tangent  plane  is  not  uniquely  defined. 

3.2  DESCRIPTION  OF  CONTACT:  CONTACT  FRAMES 

Geometric  frames  merely  model  the  local  geometry  of  the  contacting  object;  they  are  indepen¬ 
dent  of  how  MO  and  ENV  ate  contactmg  ekh  other.  Hence,  geometric  frames  do  not  unambiguously 
describe  the  contact  geometry,  especially  in  the  case  of  curves  and  vertices.  To  this  end  contact 
frames  are  introduced.  A  contact  frame  is  defined  for  both  MO  and  ENV.  They  are  named  {con} 
and  {con'},  respectively.  Their  origin  lies  at  the  contact  point,  and  one  axis  lies  along  the  contact 
normal.  Furthermore: 

Smooth  surface:  the  other  two  axes  lie  along  the  principal  directions  of  curvature.  Hence, 
for  a  smooth  surface,  the  contact  frame  coincides  with  the  geometric  frame. 

Smooth  curve:  one  axis  lies  along  the  tangent  Hence,  for  a  smooth  curve,  the  contact  fhune 
and  the  geometric  frame  coincide,  except  for  a  rotation  about  the  tangent 

Vertex:  the  contact  frame  and  the  geometric  frame  only  have  their  origin  in  common. 

!The  geometric  frame  {geo}  and  the  contact  frame  {con}  coincide  for  a  smooth  surface,  irrespective 
of  the  geometry  of  the  ENV,  but  not  for  a  smooth  curve  or  a  vertex.  This  is  because  curves  and 
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vertices  do  not  possess  two  independent  tangent  vectors  in  the  point  of  contact,  as  explained  in  3. 1 . 
Hence,  the  definition  of  the  contact  frame  for  a  curve  or  vertex  of  the  MO  requires  the  knowledge  of 
one  or  two  of  the  tangent  vectors  of  the  ENV,  and  vice  versa.  For  the  same  reason,  the  edge-vertex, 
vertex-vertex  or  edge-parallel  edge  contacts  are  unstable:  no  two  independent  tangent  vectors  exist, 
:.o  that  contact  normal  and  tangent  plane  are  also  not  defined. 

3.5  KINEMATIC  MODEL  OF  POINT  CONTACT  VIRTUAL  MANIPULATORS 

In  principle,  the  equations  describing  the  geometry  of  the  surfaces  of  both  MO  and  ENV 
are  sufficient  to  model  the  instantaneous  motion  freedom  of  the  MO.  However,  the  use  of  these 
geometric  models  for  the  specification  of  the  desired  motion  is  not  straightforward.  Therefore,  the 
geometric  rnodel  is  replaced  by  a  kinematic  model:  this  means  that  the  MO  and  the  ENV  are  lirtked 
by  a  virtual  manipulator,  which  gives  the  same  reciprocal  motion  freedom  as  allowed  by  the  contact 
The  motion  of  the  MO  is  then  expresred  as  the  “joint  motions”  of  this  virtual  contact  manipulator. 
The  kinematic  strircmre  of  the  virtual  contact  manipulator  is,  as  much  as  possible,  determined  by  the 
local  geometric  properties  of  the  contacting  objects,  as  described  in  subsection  3.1,  i.e.,  the  tangent 
vectors  and  the  principal  directions  (and  centres)  of  curvature.  The  vitnial  contact  manipulator 
consists  of  three  connected  sub>manijpulators; 

1 .  SUP.  This  fim  sub-manipulator  has  two  degrees  of  freedom,  which  correspond  to  the  motion 
of  the  contact  point  on  the  surface  of  die  MO.  It  links  the  MO  to  the  {con}  frame  as  follows. 
Fust,  choose  a  reference  frame  {5aae}  on  the  MO,  which  serves  as  the  base  of  the  virtual 
manipulator.  {6aae}  is  chosen  arbitrarily.  Furthermore: 

Smooth  surface.  Connect  the  base  frame  to  a  -"volute  joint  at  the  centre  of  curvamre  cor¬ 
responding  to  the  largest  radius  of  curvature,  and  with  its  joint  axis  parallel  to  the 
direction  of  maximum  curvature;  connea  to  this  joint  a  second  revolute  joinL  at  the 
centre  of  curvature  corresponding  to  the  smallest  radius  of  curvature,  and  with  its  joint 
axis  parallel  to  the  direction  of  minimum  curvature.  Connect  the  contact  frame  {con} 
to  this  second  joinL  see  Figs.  3  and  4. 

Smooth  curve.  Connect  the  base  frame  to  a  revolute  joint  at  the  centre  of  the  osculating 
circle  and  with  its  axis  parallel  to  the  direction  of  the  binomial.  Attach  it  to  a  second 
revolute  joint  along  the  tangent  at  the  contact  point  Connect  the  contact  frame  {con} 
to  this  second  joint 

Vertex.  Connect  the  base  frame  to  two  revolute  joints,  both  in  the  vertex,  and  with  their  axes, 
in  principle,  in  arbitrary  directions.  So,  one  could  prefer  to  make  these  axes  parallel 
to  some  of  the  other  axes  in  the  total  virtual  contact  manipulator.  Connea  the  contact 
frame  {con}  to  the  second  joint 

2.  ROT.  A  one  degree  of  freedom  manipulatot,  connecting  SUP  and  SUD  by  a  fifth  revolute 
joint  along  the  common  contaa  normal  axes  of  {con}  and  {con'}. 

3.  SUD.  This  third  sub-manipulator,  with  base  frame  {base'}  is  similar  to  SUP.  It  has  also  two 
deg^s  of  freedom,  corresponding  u>  the  motion  of  the  contaa  point  on  the  surface  of  the 
ENV.  It  links  the  ENV  to  the  {con'}  fiame  in  a  similar  way  as  SUP  links  the  MO  to  {con}. 

The  twist  system  T  of  the  MO  due  to  these  virtual  manipulators  is  the  union  of  the  following 
subspaces: 

1.  T*'*’’  (slipping):  motion  of  the  MO  due  to  the  motion  of  the  joints  in  SUP.  This  does  not 
move  the.contact  point  with  respect  to  the  ENV,  but  it  does  change  the  contact  point  on  the 
surfuepf  the  AfO.  See  Fig.  3. 
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Figure  3:  Virtual  manipulators.  Virtual  manipukuois  for  the  case  where  both  MO  and  EN\'  are 
smooth  surfaces  (left).  Slipping  (middle)  moves  the  MO  without  changing  the  contact  point  on  the 
EffV.  Sliding  (tight)  moves  the  MO  without  changing  the  contact  point  on  the  MO.  For  reasons  of 
clarity,  the  figure  shows  only  2D  motion. 

2.  (rotation):  motion  about  the  common  contact  normal  axes  of  the  contact  frames,  i.e. 
motion  of  the  ROT  manipulator.  The  contact  point  does  not  move  in  space. 

3.  (sliding):  motion  of  the  MO  due  to  the  motion  of  the  joints  in  SLID.  This  does  not 
move  the  contact  point  with  tespea  to  the  MO,  but  it  does  change  the  contact  point  on  the 
surface  of  the  ENV.  See  Fig.  3. 

The  special  combination  of  slipping  and  sliding  such  that  the  contact  points  on  the  surfaces  of  MO 
and  £Wmove  with  the  same  instantaneous  velocity,  is  called  rolling. 

With  these  subsystems  of  motion  freedom  (each  corresponding  to  parts  of  the  virtual  manipula¬ 
tor),  the  specification  of  the  desired  instantaneous  velocity  of  the  MO  is  performed  in  a  model  based 
and  user  friendly  nuumer.  One  should  keep  in  mind,  however,  that,  in  general,  for  a  compliant 
motion  task  only  instantaneous  velocities  or  it^mtesimal  displacements  are  specifiable,  but  not 
finite  displacementsl 

During  on  line  execution  of  a  compliant  motion  task,  the  MO's  measured  motion  t  is  decomposed 
into  components  of  the  abovementitmed  subspaces: 

t  =  t*‘»-l-t’^**  +  t*'“.  (7) 

This  decomposition  gives  the  following  model  updau  infonnation:  both  contact  frames  are  rotated 
w.r.L  each  other  over  the  rotation  component  t'''^,  the  contact  frame  has  moved  over  the  surface 
of  MO  by  the  slipping  component  t*'*’’,  and  over  tire  surface  of  the  ENV  by  the  sUdiog  component 
t*’’**.  See  3.9  for  more  details. 


3.4  MATHEMATICAL  REPRESEm'AnON:MCOBIANS 

Slipping,  sliding  and  rotation  completely  define  the  five  degrees  of  freedom  of  the  manipulated 
object  with  respect  to  itt  environment,  as  allowed  by  the  second  order  model  of  the  conucting 
surfaces.  This  subsection  presents  a  numerical  description  of  this  motion  freedom,  based  on  the 
reference  fiame  definitioos  of  the  previous  subsections.  Ite  only  things  that  are  still  miMing  are: 
1 )  a  systematic  liaining  convehtibh  for  the  reference  friune  axes  (X  F  and  Z),  and  2)  the  matrices 
representing  numerical  bases  for  the  twist  and  wrench  systems  of  the  motion  constraints  (i.e..  the 
so-caiiedJdcdbims). 
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3.4.1  Geometric  Frames  First,  the  axes  of  the  geometric  frames  {^eo}  and  {^eo'}  are  chosen 
in  a  systematic  way,  see  Fig.  4; 

1.  Smooth  swfiMe.  The  Z  axis  lies  along  the  surface  normal:  the  X  and  F  axes  along  the 
directions  of  minimum,  respectively  maximum  curvature.  Freedom  of  choice  for  X  and  F  if 
the  surface  is  umbilk  in  the  contact  point 

2.  Smooth  cum.  The  X,  F  and  J?  axes  lie  along  the  tangent  binormal  and  normal  directions, 
in  this  order.  Freedom  of  choice  for  F  and  Z  if  the  curve  is  a  straight  line. 

3.  Vertex.  Full  freedom  of  choice.  A  practical  choice  is  to  make  the  geometric  frame  {peo} 
coincid*  with  the  contact  frame  {eon}  defined  in  the  following  subsection. 


Figure  4:  Geometric  and  contact  reference  frames.  Foreachofthecontactclasses,  the  location  and 
the  relative  motion  freedom  of  the  {geo}  and  {con}  reference  frames,  with  respect  to  the  {base} 
reference  frame,  ate  indicated. 


3.4.2  Contact  Frames  Second,  the  contact  frames  ate  defined:  the  origins  of  {con}  and  {con'} 
lie  at  the  contact  point;  their  Z  axes  lie  along  the  contact  normal,  and  point  “into”  the  MO  and 
the  ENV,  respectively.  This  means  that  the  Z  axes  of  {con}  and  {con'}  have  opposite  directions. 
Frir\hetmbte: 


1.  Smooth  surface:  X  and  F  coincide  with  the  X  and  F  axes  of  the  geometric  frames. 

2.  Smooth  curve:  X  coincides  with  the  X  axis  of  the  geometric  frame,  i:e.,  the  tangent  to  the 
curve.  The  F  axis  is  derived  from  the  knowledge  of  X  and  Z. 
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3.  Vertex:  The  contact  ftame  for  a  vertex  MO  is  fully  determined  by  the  contact  frame  of  the 
£WV,  and  vice  versa.  n'.eeasiestchoiceistolet{seo},  {peo'  },  {con}  and  {am!}  all  coincide 
(taking  into  account  that  the  Z  axes  of  the  prin^  and  unptimed  frmnes  are  in  the  opposite 
directions). 

3.4.3  Transformations  Third,  the  transformations  between  all  the  frames  are  defined  in  terms 
of  a  simple,  minimal  and  unambiguous  set  of  geometrical  parameters: 

1.  {con}  -*  {^eo}:  this  transformation  is  the  identity  transformation,  except  for. 

Smooth  curve:  the  Z  axis  of  {con}  is  rotated  about  common  X  axis  (tangent  direction) 
over  an  angle /lx. 

Vertex:  in  cMe  the  geometric  frame  and  the  contact  frame  are  not  chosen  to  coincide,  the  Z 
axis  of  {con}  is  first  rotated  about  the  X  axis  over  an  angle  /ix.  then  about  the  Y  axis 
over  an  angle  /ty.  Remark  that  the  order  of  the  rotations  matters,  because  /i,  and  /ty  are 
in  general  of  fitiite  magnitude. 

2.  {con'}  -*  {gee/}:  «itniUr  to  the  previous  transformation,  with  only  a  notadonal  difference: 
the  possible  rotation  angles  are  called  rjx  and  r/y. 

3.  {con'}  -+  {con}:  these  frames  only  differ  by  1)  a  rotation  over  180  degrees  (about  X  or  Y) 
since  the  Z  axes  have  opposr*e  direcions.  and  2)  a  rotation  about  their  common  Z  axis.  This 
rotation  angle  is  called  p. 

3.4.4  Jacobians  A  basis  of  the  twist  system  T  is  given  by  the  6  x  5  Jacobian  matrix 
composed  of  slipping,  rotation  and  sliding: 

J'®*  J*'").  (8) 

The  meaning  of  the  term  “Jacobian"  is  exactly  the  same  as  in  robot  kinematics:  each  column  of 
the  Jacobian  represents  the  velocity  of  the  “end  effector"  of  the  virtual  manipulator  corresponding 
to  the  velocity  in  one  of  the  manipulator's  joints.  The  different  sub-Jacobians  are  expressed  in 
terms  of  the  geometric  parameters  of  the  contact,  and  in  the  frame  which  results  in  the  simplest 
representation.  See  Fig.  4  for  the  definition  of  the  reference  frames. 

1.  The  5L/F  Jacobian  is  expressed  with  respect  to  {peo}. 

Smooth  sotface.  Its  first  column  represents  the  rotation  about  the  first  revolute  Joint  of  the 
SUP  virtual  mxnipiiiatnr  This  joint  lies  at  the  centre  of  curvature  corresponding  to  the 
largest  radius  of  curvature.  Its  axis  is  paraliei  to  the  Y  axis.  The  distance  between  this 
joint  and  the  contact  point  is  noted  r^.  .Similarly,  the  second  column  represents  the 
rotation  about  the  second  revolute  joint  of  the  SUP  manipulator.  Its  axis  is  parallel 
to  the  X  axis.  is  the  distance  between  this  joint  and  the  contact  point;  it  is  the 
smallest  radius  of  curvature  at  the  contact  point  Hence: 


Smooth  curv£.  The  direction  of  maximum  curvature  degenerates,  and  only  the  curvature 
along  the  curve  remains.  This  curvature  is  represented  by  the  radius  r”*”  of  the  osculating 
circle,  and  corresponds  to  a  rotation  about  a  revolute  joint  placed  in  the  centre  of  this 
circle,  and  with  its  axis  parallel  to  Y.  The  second  joint  is  a  rotation  about  the  tangent 
X.  Hence,  the  SUP  Jacobian  becomes: 


0  1 
a  0 
0  0 
-r"“a  0 
0  0 
0  0 


/j  +(rnu>)2 


This  is  consistent  with  the  Jacobian  for  a  smooth  surface  since  Eq.  (10)  is  the  limit  case 
ofEq.(9)forr~  -.0. 

Vertex.  The  directions  of  both  maximum  and  minimum  curvature  are  degenerated.  Since 
the  two  joints  of  the  SUP  manipulator  correspond  to  rotations  about  the  contact  point, 
the  Jacobian  becomes: 


Once  again,  this  is  the  limit  of  the  previous  Jacofaians  for  r|5J„  -*■  0. 

2.  Tlie  /fOT  Jacobian  is  expressed  with  respect  to  {con}  and  {con'},  and  is  very  simple: 


Jrat  __  ,  jrot  ^ 

—  can' 


3.  The  SUD  Jacobian  is  expressed  with  respect  to  {ged}:  is  completely  sunilar  to 

J*'*'’,  i.e.,  replace  all  ‘Ws  by  ••eftv"s.  For  symmetry  reasons,  however,  the  order  of  the 
columns  is  interchanged. 

The  three  uppermost  rows  of  the  Jacobians  represent  angular  velocities  (with  physic^  units  Utime), 
the  three  rows  at  the  bottom  are  translational  velocities  (with  physical  units  length/time). 

The  coefficients  a  and  6  ate  chosen  in  such  a  way  as  to  allow  an  easy  transition  to  the  limiting  c^s 
with  zero  or  infinite  curvature.  These  coefficients  are  not  dimensionless:  their  units  are  l/time. 
Hence,  the  1  s  in  the  nominator  and  denominator  also  have  the  appropriate  physical  dimensions:  the 
nominator  has  units  of  l  /time,  the  1  in  the  denominator  has  units  of  length  squared.  This  should 
be  kept  in  mind  whenever  a  change  of  physical  units  is  petformed. 


i* 


3.4.5  Transformation  of  JacobUms  Finally,  a  Jacobian  expressed  with  respect  to  a  reference 

frame  {a}  is  transformed  to  another  reference  frame  {6}  using  a  screw  transformation  matrix  J5:  \ 

iJ  =  JS  aJ,  ts  =  [  aji  ]  •  (13) 

03x3  is  the  3  by  3  zero  matrix.  is  the  rotation  matrix  between  both  reference  frames,  [r^a  x  1  is 
the  matrix  representing  the  vector  product  with  r^a  linking  the  origins  of  the  reference  frames  {&} 
and  {a}: 

0  -r,  ry 

[rfc,x]=  Vr  0  -r,  ,  (14) 

.  “’’v  0 

with  r,  =  (ria),,  i  =  x,y,zlht  components  of  rja  along  the  X,  Y  and  Z  unit  vectors. 


For  example,  when  expressing  all  sub>Jacobtans  with  respect  to  the  {^eo}  frame  on  the  MO, 
the  following  transformations  apply: 


Table  1  shows  which  of  pz,py,Vxtt}y  aiui  pan  zero  in  a  specific  case.  For  example,  in  case  of 
a  contact  between  two  surfaces  the  geometric  and  contact  hrames  coincide:  {geo)  =  {con}  and 
{^eo'}  =  (con'}.  Hence  Eq.  (15)  simplifies  to: 

=con  i  S{p)  J*'“j  •  (16) 

In  case  of  a  contact  between  a  vertex  and  a  surface,  px,  py  and  p  may  be  chosen  zero,  by  making 
the  geometric  and  contact  frames  coincide.  Eq.  (15)  then  Either  reduces  to: 


jini  _  f. 

OW  —C^  V 


:  ^S{p  =  0)  J""  . 


In  case  of  a  contact  between  two  curves  Eq.  (15)  reduces  to: 

j.cJ"’**'  =  [jeoJ'*"'’  ;  ^oS{Px)  ^S{px}  ^  S{p)  ^,S(»7.)  ■  (18) 

With  respect  to  the  basis  {a},  a  twist  ot  between  the  MO  and  the  ENV  is  written  as: 

(19) 

where  r  is  a  column  vector  representing  the  (physically  dimensionless!)  magnitudes  of  the  joint 
velocities  (or  infinitesimal  displacements)  in  the  virtual  manipulator,  due  to  the  “end  effector’’  twist 
t  of  the  MO.  The  twist  coordinate  vector  T  remains  unchanged  under  a  change  of  reference  frame 
as  in  Eq.  (13),  hence  it  carries  no  reference  frame  subscript. 


jl:' 


.  ^  -  -f 


5 


Table  1:  Frame  transformation  parameters.  The  geometric  and  contact  frames  are  linlfftH  by  a  set 
of  transfonnation  parameters.  This  set  depends  on  the  type  of  the  contact  For  the  contact  involving 
a  vertex,  the  geometric  and  contact  frames  may  be  chosen  coincident  (p  -  0,  and  p.  =  py  =  0 
or  nx  =  i]y  =  0):  the  contact  frame  of  the  vertex  is  chosen  with  its  and  y  axes  parallel  to  the 
corresponding  axes  of  the  contact  frame  of  the  other  surface  with  which  it  is  in  contact 


3.5  POLYHEDRAL  OBJECTS:  EDGES  AND  FACES 

The  previous  par^raphs  describe  a  contact  between  two  smooth  curves  and/or  surfaces.  How¬ 
ever,  contacts  involving  ^ges  (i.e.,  straight  lines)  or  faces  are  very  common  in  industrial  assembly. 
An  edge  has  zero  curvature  along  the  curve;  a  face  has  zero  curvature  in  all  directions.  Formally, 
the  contact  models  for  this  type  of  motion  constraint  correspond  to  the  limit  cases  of  the  smooth 
objects;  the  radii  of  curvature  go  to  infrni^,  i.e.  the  revolute  joint  moves  to  infinity,  so  it  becomes 
a  prismatic  joint  For  example.  Fig.  5  shows  a  vertex-face  contact  The  Jacobian  expressed  in  the 
contact  frame  is  derived  from  Eq.  (17).  Furthermore,  is  given  by  Eq.  (11);  is  given 

by  Eq.  (12),  and  is  derived  from  Eq.  (9)  by  interchanging  the  columns  and  taking  the  limits 

for  r^,  r^in  This  results  in: 


rind  _ 

vertex— /ace 


0  10  0  0 
1  0  0  0  0 
0  0  10  0 
0  0  0  0  1 
0  0  0  1  0 
0  0  0  0  0 


Sliding  is  now  the  translational  motion  of  the  MO  over  the  face  of  the  ENV,  slipping  and  rotation 
correspond  to  rotation  around  the  contact  point  about  all  three  axes  of  the  contact  frame. 

By  taking  similar  limits,  the  other  special  cases  of  edge-face  aai  face-face  contacts  result  For 


'v, , 


^ , 


Figure  5:  Polyhedral  contacts.  The  MO  consists  of  a  vertex  (left)  or  an  edge  (right);  the  ENV  is 
a  face.  The  drawing  also  gives  an  expanded  view  of  the  viitual  manipulator  for  the  vertex-face 
contact:  the  serial  connection  of  a  spherical  joint  (i.e.  three  intersecting  revolutes,  “R")  and  two 
prismatic  joints  (“P”)  with  intersecting  axes. 


an  edge-face  contact.  Fig.  5; 


■  1 


r2n<t  _ 


1  0 
0  0 


(21) 


The  MO  has  four  degrees  of  freedom  in  this  motion  constraint,  hence  the  dimension  of  the  twist 
system  is  four.  This  is  reflected  in  the  Jacobian  since  the  first  and  fifth  colunuis  are  dependent. 
There  is  also  an  ambiguity  in  selecting  the  origin  of  the  contact  frames:  any  point  along  the  contact 
line  will  do.  Similarly,  for  a  face-face  contact’ 


t2i%^ 

con  V /oee— /ace  ' 


The  MO  has  three  degre.'ts  of  freedom  in  this  motion  constraint,  hence  the  dimension  of  the  twist 
system  is  three.  This  is  icAected  in  the  Jacobian  since  the  first  and  fifth  columns  are  dependent  as 
well  as  the  second  and  fourth  columns.  Sinularly,  there  is  an  ambiguity  in  selecting  the  origin  of 
the  contact  frames:  any  point  in  the  contact  plane  will  do. 

The  procedure  presented  in  Sect  3.4  also  allows  the  representation  of  mixed  polyhedtal/non- 
polyhedral  contacts.  For  example,  the  contact  between  an  edge  and  a  cylinder. 

3.6  FIRST  ORDER  APPROXIMATION  OF  A  POINT  CONTACT 

Even  if  the  contact  surfaces  are  not  polyhedral,  it  is  common  practice  to  work  with  a  first 
order,  or  polyhedral,  approximation.  For  example,  the  contact  in  Fig.  3  could  be  modelled  by  the 
polyhedral  model  of  Fig.  5  (left),  if  the  curvature  of  the  MO  is  significantly  larger  than  that  of  the 
ENV. 
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First  and  second  order  models  give  the  same  instantaneous  velocities  for  the  MO,  i.e.  their 
Jacobian  matrices  span  the  same  twist  space  T.  However,  compared  to  the  first  order  model,  the 
second  order  model  retains  more  informadon  to  interpret  the  executed  motion  of  the  MO,  i.e.,  the 
subdivision  into  slipping,  sliding  and  rotation.  Moreover,  it  predicts  the  evolution  of  the  contact 
fhunes  during  the  motion  more  accurately  since  it  models  changes  in  the  direction  of  the  contact  ! 

normal,  which  is  impossible  in  a  first  order  model.  Hence,  the  usefulness  of  first  order  models  relies 
more  heavily  on  the  ability  of  the  compliant  motion  controller  to  identify  on  linr.  the  deviations 
between  the  model  and  the  real  world.  These  deviations  are  also  larger  than  for  second  order 
models. 


3.7  WRENCH  SYSTEM 


Besides  a  model  of  the  allowed  reciprocal  motion,  the  robot  controller  has  to  know  what  reaction 
forces  it  can  expect,  i.e.  it  has  to  know  the  wrench  system  W.  For  any  modon  constraint  for  which 
a  kinemadc  model  of  the  modon  freedom  T  exists,  a  basis  for  W,  i.e.  a  wrench  Jacobian  G,  can 
be  found  numerically  as  follows:  G  is  a  basis  of  the  vector  space  reciprocal  to  the  twist  system 
T.  This  calculadon  is  similar  to  the  calculadon  of  the  orthogonal  complement,  but  with  the  matrix 
A  of  Eq.  (S)  as  the  “orthogonality”  matrix  instead  of  the  unit  manix.  Golub  and  Van  Loan  (1989) 
contains  robust  algorithms. 

For  a  general  point  contact,  with  a  twist  Jacobian  as  in  Eq.  (8),  this  results  in  the  following 
simple  expression  with  respect  to  the  contact  frames: 


G  = 


(23) 


I 


For  the  edge-face  and  face-face  contacts  the  wrench  system  has  dimension  two  or  three: 


^edge-face 


0 

O' 

■  0 

0 

0  ■ 

0 

0 

0 

0 

0 

I 

0 

1  Gface-faee  — 

1 

0 

0 

0 

0 

0 

1 

0 

0 

1 

0 

0 

1 

0 

0 

0 

0 

0 

(24) 


With  respect  to  the  basis  G,  every  (ideal)  contact  wrench  w  is  expressed  as 

w  =  Gr, 

where  r  is  a  column  vector  representing  the  (physically  dimensionless)  coordinates  of  the  wrench 
w. 

3.8  KINEMATIC  MODEL  FOR  NEAR-CONTACT 

Every  compliant  modon  task  starts  with  an  approach  move  to  bring  the  AfO  in  contact  with  the 
ENV.  The  last  part  of  this  approach  (i.e.  the  so-called  near-contact  phase)  must  take  place  under 
force  control,  and  hence  is  also  a  compliant  motion.  The  virtual  manipulator  linking  the  MO  to 
the  ENV  in  the  general  point  contact  m^el  of  Fig.  3  is  extended  with  the  APP  virtual  manipulator. 
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consisting  of  a  prismatic  joint  along  the  common  normal.  The  contact  frames  on  MO  and  ENV 
keep  the  same  definition  as  in  the  case  of  real  contact,  but  their  origins  are  now  chosen  at  the 
intersections  of  the  common  normal  with  the  surfaces  of  MO  and  ENV.  Accordingly,  the  Jacobian 
is  extended  with  one  column: 

j2n<<,nc  _  |j2nd  jappj  ^26) 

With  respect  to  the  {con}  frame,  is  as  follows: 


Any  twist  t  of  the  MO  with  respect  to  the  ENV  is  now  decomposed  into  slipping,  rotation,  sliding, 
and  approach  along  the  common  normal: 

t  =  +  +  +  (28) 


3.9  EVOLUTION  OF  THE  CONTACT  FRAME  LOCATION:  KINEMATIC  DESCRIPTION 

A  good  model  not  only  describes  die  instantaneous  reciprocal  motion  freedom  of  the  MO,  but 
also  indicates  bow  this  motion  freedom  evolves  due  to  the  motion  itself.  Slipping  and  sliding  move 
the  point  of  contact  over  both  the  MO  and  the  ENV,  so  the  location  of  the  contact  normal  and 
the  tangent  vectors  change.  Hence,  the  locations  of  the  {gto},  {con),  {con'}  and  {geol}  reference 
frames  change  with  respect  to:  1)  the  base  frames  {base}  and  {base'},  and  2)  some  reference  frames 
{ref }  and  {ref},  which  are  chosen  (arbitrarily,  but  fixed  once  and  for  all)  on  the  MO  and  the  ENV, 
respectively.  This  Section  shows  how  to  derive,  riom  the  motion  of  the  virtual  manipulators,  the 
evolution  of  the  contact  and  geometric  frames  with  respect  to  the  fixed  reference  frames  {ref }  and 
{ref}.  To  this  end,  the  concept  of  the  evolution  transformations  EVOL  and  EVOL'  is  introduced, 
see  Fig.  6.  These  transfonnations  complement  the  previously  presented  kinematic  model  of  the 
instantaneous  motion  freedom  as  follows: 

1 .  EVOL  contains  the  current  transformation  between  {ref}  and  the  {base}  of  the  virtual  SUP 
manipulator. 

2.  EVOL’  contains  the  current  transformation  between  {ref}  and  the  {6ase'}  of  the  virtual 
SLID  manipulator. 

Updating  EVOL  and  EVOL'  brings  the  virtual  manipulators  SUP  and  SUD,  which  are  used  for  the 
instantaneous  motion  specification,  back  to  their  “zero  positions’’:  whenever  the  specified  desired 
“joint  velociues”  of  SUP  and  SUD  have  moved  die  joints  of  these  virtual  manipulators  over  a  small 
angle  (and  hence  the  MO  over  some  infinitesimal  distance  with  respect  to  the  ENV),  this  motion  is 
incorporated  into  the  EVOL  EVOL’  transformations.  This  means  that  the  base  frames  of  SUP 
and  SUD  are  moved,  in  the  same  way  as  the  contact  firames. 

The  following  list  of  the  topology  of  the  kinematic  chains  linking  {ref}  to  the  contact  frames, 
(see  also  Fig.  4),  is  used  to  determine  which  components  of  the  execut^  motion  are  needed  to 
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update  the  evolution  transformations.  I  is  the  idendor  transformadon.  (At  the  side  of  the  ENV,  the 
list  is  completed  symmetrically.) 


SUP  ROT 

Smooth  surface :  {ref}  {6aae}  ^^{geo)  {con}  {con'} . . . 

SUP  «OT 

Smooth  curve  :  {ref}  {iase}  {geo}  -^{con}  {con'} . . . 

SUP  ROT 

Straight  line :  {ref}  {6aae}  {geo}  -^{con}  {con'} . . . 


SUP 


ROT 


Vertex*  :  {ref}  {6ase}  ^^{geo}  {con}  {con') . . . 


(29) 

(30) 

(31) 

(32) 


Virtual 

contact 

manipulators 


Known 

transformations 


Figure  6:  Evolution  transformations.  The  boxed  circles  represent  virtual  manipulators,  used  to 
describe  instantaneous  modon  freedom;  the  ellipses  represent  known  transformadons  between 
reference  frames.  EVOL  and  EVOL’  describe  the  actual  locadons  of  the  base  frames  of  SUP  and 
SUD,  with  respect  to  the  known  reference  frames  {ref}  and  iref'}. 


3.9.1  Evolution  of  the  Contact  Francs  In  order  to  update  the  location  of  the  contact  frames, 
the  base  frames  are  chosen  coincident  with  the  contact  hmes  in  the  “zero  position”  of  the  virtual 
manipulators.  (Remember  that  the  choice  of  {hose}  and  {base'}  is  arbitrarily!)  Eqs.  (29)-(32) 
then  show  that,  in  order  for  {6ase}  to  track  the  modon  of  {con},  the  evolution  transformation 
EVOL  should  be  updated  by  the  motion  of  the  SUP  manipulator.  Similaiy  in  order  for  {base'}  to 
track  {con'},  the  evolution  transformation  EVOL’  should  be  updated  by  the  motion  of  the  SUD 
manipulator. 


3.9.2  Evolution  of  the  Geometric  Frames  Updating  the  location  of  the  geometric  frames  pro¬ 
ceeds  along  the  same  lines.  The  base  frames  are  now  chosen  coincident  with  the  geometric  hames  in 
the  “zero  position”  of  the  virtual  manipulators.  Again,  Eqs,  (29)  -(32)  determine  how  the  evolution 
transformations  should  be  updated  in  mder  for  the  base  frames  to  track  the  motion  of  the  geometric 
frames  :  for  smooth  surfaces  or  vertices,  there  is  no  difference  with  the  evolution  of  the  contact 
frames,  while  for  curves  and  edges  only  the  first  joint  in  the  virtual  manipulators  {SUP  and  SUD) 
is  needed. 


If  the  geomeric  fnune  is  chosen  to  coincide  widi  the  conua  frame! 
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3.9.3  Validity  Range  of  Kinematic  Model  Clearly,  if  the  relative  location  of  the  contact  frames 
{con}  and  {con'}  with  respect  to  the  reference  frames  on  the  MO  and  the  £A/V  changes  over  an 
extenaed  range,  the  second  order  approximation  of  the  surfaces  may  not  remain  valid.  This  is 
because,  for  arbitrarily  curved  surfaces,  the  principal  directions  and  the  corresponding  curvamres 
vary  with  the  location  of  the  contact  point  on  the  surface.  Hence,  besides  continuously  updating 
the  evolution  transformations  EVOL  and  EVOL',  also  the  Icinematic  construction  of  the  virtual 
manipulator.  (i.e.,  its  link  lengths  and  the  orientation  of  its  joints  in  space),  has  to  be  adapted  in  a 
second,  less  frequently  applied  update  step. 

3. 10  EVOLUTION  OF  THE  CONTACT  FRAME  LOCATION:  MATHEMATICAL  REPRESENTATION 

3.10.1  EvolutionoftheContactFrames  Numerically,  the  evolution  ofthecontactframes  {con} 
and  {con'}  is  expressed  by  the  twists  te  and  t^: 

te  =  f;£,  tl  =  JS'e',  (33) 

where  E  and  E'  are  the  evolution  Jacobians.  From  the  previous  sections,  it  is  clear  that  these 
evolution  Jacobians  correspond  to  the  SUP  and  SUD  Jacobians,  respectively.  So,  these  are  subma¬ 
trices  of  with  proper  sign.  €  and  e'  are  the  corresponding  subvectors  of  r .  T  is  determined 

by  Eq.  (19),  with  replaced  by  in  case  of  near-contact 

Alternatively,  one  can  be  interested  in  knowing  the  evolution  of  {con}  with  respect  to  {re /'}, 
or  {con'}  with  respect  to  {re/}.  Again.  Eqs.  (29H32)  determine  which  columns  from  one 
needs.  Table  2  lists  the  evolution  Jacobians  E  and  E'  for  these  cases. 
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te  and  Vg  are  used  to  update  the  transformations  EVOL  and  EVOL’.  Mathematically,  at  a  given 
time  instant  t,  EVOL  and  EVOL'  are  characterized  by  the  screw  transformation  matrices  ^S(t)  and 

between,  on  the  one  hand,  the  contact  frames  {con}  and  {con'}  and,  on  the  other  hand, 
their  respective  reference  frames  {ref}  and  {ref}.  After  some  infinitesimal  time  interval  At, 
the  contact  frames  have  moved  with  respect  to  their  respective  reference  frames  over  infinitesimal 
displacements  t*^  and 

te^  =  teAt,  te4  =  t'eAf.  (34) 

Hence,  the  evolution  transformations  have  to  be  updated  as: 

^5(t  -I-  At)  =  tTfSit)  S(t.^),  +  At)  =  ^:S{t)  5(t' ^),  (35) 

where  5(t*4)  and  5(tj^)  arc  screw  transformation  matrices  corresponding  to  the  infinitesimal 
displacements  tg.a  and  tg,^  (expressed  in  {con}  and  {con'},  respectively):  if  ta  has  Cartesian 
components  (6x  6y  6,  d,  dy  d^f,  then  5(ta)  is  easily  derived  from  Eqs.  (13)  and  (14)  as: 


S(ta)  = 
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-6y 

0 

d. 
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-d, 

0 

dx 
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-dx 
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0 

0 

0 

1 

fiz 

-S. 


0 

0 

0 

-6x 

1 

Sx 


0 

0 

0 

6y 

1 


(36) 


In  a  second  update  step,  the  evolution  Jacobians  E  and  E'  in  Eq.  (33)  have  to  be  adapted  contin¬ 
uously,  because,  as  explained  in  the  previous  subsection,  the  curvatures  in  the  contact  point  may 
change,  and  hence  also  the  corresponding  columns  of  the  Jacobians  J,  E  and  E'. 
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E 

(evolution  of  {con}) 

E' 

(evolution  of  {con'}) 

w.r.t.  {ref} 

-JthP 

-  J”‘  J“H 

w.r.t.  {ref} 

J“Fpj 

jtiid 

Table  2:  Evolution  Jacobians.  The  modelled  evolution  of  the  contact  frames. 


3.10.2  Evolution  of  the  Geometric  Frames  Again,  for  smooth  surfaces  or  vertices  there  is  no 
difference  with  the  evolution  of  the  contact  frames,  while  for  curves  and  edges  only  one  column, 
coiresponding  the  first  joint  in  the  SUf  or  SLID  manipulator,  is  needed  in  the  evolution  Jacobians 
of  eq.  (33). 


3.11  kinematic  MODEL  FOR  MULTIPLE  CONTACTS 


In  case  several  contacts  exist  between  the  MO  and  the  ENV,  as  in  Rg.  2,  a  virtual  manipulator 
is  used  to  describe  every  individual  contact  This  results  in  a  complex  kinematic  chain  connecting 
the  MO  and  the  ENV.  The  corresponding  twist  and  wrench  systems  for  the  MO  are  calculated 
with  the  composition  rales  given  in  Section  2,  i.e.  the  resulting  twist  system  is  the  intersection  of 
the  individual  twist  systems,  and  the  resulting  wrench  system  is  the  sum  of  the  individual  wrench 
systems. 

Figure  2  shows  an  example  in  which  the  MO  is  constrained  by  two  elementary  constraints,  a 
vertex-face  and  a.  face-face  contact  The  twist  Jacobian  for  the  vertex-face  contact  expressed  in  its 
own  contact  frame,  is  given  by  Eq.  (20),  and,  similarly,  the  twist  Jacobian  for  the  plane  contact 
expressed  in  its  own  contact  frame,  is  given  by  three  independent  columns  of  Eq.  (22).  The  total 
twist  Jacobian,  expressed  for  example  in  {coni },  is  given  by: 


eonl^  — 


10' 
0  0 
0  0 
0  0 
0  1 
0  0 


(37) 


3.12  KINEMATIC  MODEL  FOR  COOPERATING  ROBOTS 


The  extension  of  the  kinematic  model  to  multiple  cooperating  robots  is  straightforward.  For 
example,  for  two  robots  with  contact  between  their  manipulated  objects,  the  role  of  the  ENV  is 
played  by  the  manipulated  object  of  the  other  roboL  and  the  twist  t  is  now  really  a  relative  twist 
between  the  two  manipuiated  objects,  i.e.,  different  from  the  absolute  twists  of  both  manipulated 
objects. 


Figure  7:  Peg-in-hole:  insertion  snapshots,  from  badly  to  almost  perfectly  aligned  configurations. 

4  Example:  AUgnment  of  Cyiladriod  Peg  and  Htrie 

This  Section  applies  the  presented  kinematic  approach  to  the  peg-in-hole  example.  It  describes 
the  desired  alignment  motion  between  the  axes  of  peg  and  hole  starting  from  the  initial  position 
depicted  in  lug.  1.  This  position  is  mostly  not  considered  in  literature,  since  the  alignment  between 
the  peg  and  the  hole  is  too  bad  to  start  the  final  insertion  phase.  Nevertheless,  if  the  position  of 
the  hole  is  not  exactly  known,  and  hence  tiie  manipulator  has  to  “look  for  if’  by  (stochastically  or 
deterministically)  moving  the  peg  around  in  the  neighbourhood  of  the  current  contact  point,  this  is 
probably  the  most  interesting  relieve  position  between  the  peg  and  the  surface  containing  the  hole: 
indeed,  the  passive  compliance  in  the  system  helps  the  peg  to  “fall”  into  the  hole  once  its  bottom 
has  crossed  the  rim  of  the  hole.  In  other  words,  the  relative  position  between  peg  and  hole,  shown 
in  Fig.  1,  corresponds  to  a  very  stable  position,  that  can  be  used  to  start  a  further  alignment  motion 
before  proceeding  to  the  final  insertion. 

The  next  subsections  show  that  an  explicit  kinematic  model  of  the  contact  situation  between 
peg  and  hole  is  very  rqrproptiate  to  derive  ^  nominal  alignment  motion  for  the  peg,  given  the  time 
varying  nature  of  the  peg's  motion  tieedom.  Hence,  it  offers  a  user  friendly  interface  for  the  motion 
specification. 

4.1  MOTION  CONSTRAINTS 

The  configuration  of  Fig.  1  contains  three  point  contacts :  one  on  the  peg’s  surface,  and  two  on 
the  peg's  bottom  rim.  Hereafter,  these  contacts  are  named  Surf,  Riml  and  Rim2,  respectively.  Each 
of  these  point  contacts  removes  one  degree  of  freedom.  Borrowing  the  terminology  from  Sect  3.3, 
which  was  actually  defined  for  a  single  elementary  contact,  the  three  remaining  degrees  of  freedom 
could  be  termed  as: 

Slip.  A  pure  rotation  of  the  peg  about  its  own  axis  does  not  move  the  position  of  the  contact  points 
in  space,  but  it  changes  the  contact  areas  on  the  peg’s  surface  and  bottom  rim. 

Slide.  A  pure  rotation  of  the  peg  about  the  axis  of  the  hole  moves  the  contact  points  in  space,  but 
leaves  them  invariant  with  respect  to  the  peg. 

Insert  The  proper  combituttion  of  1)  a  rotation  about  an  axis  through  Surf,  tangent  to  the  hole’s 
rim,  and  2)  a  translation  along  the  line  through  this  contact  point  parallel  to  the  axis  of  the 
hole,  aligns  the  axis  of  the  peg  better  with  the  axis  of  the  hole.  At  the  same  time,  the  Surf 
contact  moves  closer  towards  the  peg’s  bottom,  while  the  RIM  contacts  move  towards  the 
Su^cpntact  point 

This  description  of  the  peg’s  motion  freedom  is  at  the  same  time  intuitive,  as  well  as  compatible 
with  the  kinematic  model  of  the  constraint  as  discussed  in  the  next  subsection. 
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4.2  NOMINAL  KINEMATIC  MODEL 


Each  of  the  point  contacts  Surf,  RimI  and  Rim2  has  five  degrees  of  freedom.  The  discussion 
of  Section  3  suggests  the  following  set  of  virtual  manipulators,  consisting  of  only  prismatic  and 
revolute  joints,  and  linking  the  peg  to  the  hole  with  the  same  motion  freedom  as  the  contacts: 

SURF.  This  virtual  manipulator  describes  the  reciprocal  motion  freedom  of  the  peg  w.r.t  the  hole 
as  allowed  by  the  5u>/contact,  see  Rg.  8.  It  consists  of  the  following  sub-manipulators: 

SURF-SUP:  one  cylindrical  joint,  i.e.,  a  revolute  and  a  prismatic  joint  with  their  axes 
coinciding  with  the  peg’s  axis. 

SURF-ROT:  a  revolute  joint  in  the  Surfconact  poinL  with  its  axis  along  the  contact  normal. 

SURF-SUD:  two  re  volute  joints,  one  at  the  Surf  contact  point  (with  its  axis  along  the  tangent 
to  the  hole’s  rim),  and  one  along  the  hole’s  axis. 

RJMl.  This  virtual  manipulator  describes  the  reciprocal  motion  freedom  given  to  the  peg  by  the 
first  RIM  contact  point,  see  Fig.  9.  It  consists  of  the  following  sub-manipulators: 

RIMI -SUP:  one  revolute  joint  on  the  peg’s  axis,  and  a  second  revoiute  joint,  tangent  to  the 
peg’s  bottom  rim,  and  with  its  centre  in  the  RimI  contact  point 

RIMI -ROT:  a  revolute  joint  in  the  RimI  contact  point  and  with  its  axis  along  the  contact 
normal. 

RIMI-SUD:  two  revohite  joints,  one  at  the  RimI  contact  point  (with  its  axis  along  the 
tangent  to  the  hole’s  rim),  and  one  along  'he  hole’s  axis. 

RIM2.  Completely  similar  to  RIMI,  but  now  at  the  Rim2  contact  point 

The  three  virtual  manipulators  form  three  parallel  paths  in  the  graph  describing  the  topology  of 
the  motion  constraint  see  Fig.  10.  Hence,  the  instantaneous  motion  freedom  of  the  peg  w.r.t  the 
hole  is  given  by  the  iruersection  of  the  twist  spaces  corresponding  to  each  of  the  virtual  manipulators. 
A  topological  mobility  analysis  according  to  tte  Chebyshev-Griibler-Kutzbach  formula.  Angeles 
(1988),  results  in: 

1.  Number  ofdegrees  of  freedom  constrained  in  each  joint;  d  =  5. 

2.  Number  of  one-degree-of-fieedom  joints:  j  —  15. 

3.  Number  of  bodies  (three  chains  of  four  bodies,  plus  MO  and  ENV  );rt  =  3x4  +  2=14. 

4.  Number  of  degrees  of  freedom  =  6  x  (n-  1)  -  j  x  d  =  3. 

This  analysis  breaks  down  at  two  singular  configunuiotts:  the  first  one  coincides  with  the  desired 
end  position  (i.e.,  axes  of  peg  and  hole  me  par^l);  the  second  one  is  the  limit  case  of  all  possible 
initi^  configurations  (i.e.,  axes  of  peg  and  hole  ate  perpendicular).  The  three  previously  introduced 
degrees  of  ^dom  (Slip,  Slide  arid  Insert)  allowed  by  the  three  point  contacts  correspond  to  three 
independent  drivers  for  the  complex  kinematic  chain  formed  by  SURF,  RIMI  and  RIM2:  this  means 
that  if  a  motion  is  spnified  as  a  combination  of  Slip,  Slide  and  Insert,  the  motion  of  all  joints  in 
the  chain  is  uniquely  defined. 

In  principle,  the  topolo^  and  the  link  lengths  and  link  angles  of  the  virtual  manipulators  remain 
unchanged  during  the  complete  alignment  motion,  since  the  geometry  of  tx>th  objects  is  perfectly 
described  by  a  second  order  model.  The  definition  of  RIMI  and  RIM2  uses  three  revolute  joints  at 
the  contact  points  which  have  their  axes  aligned  with  some  geometric  features  (tangents,  normals) 
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forces  on  the  other  hand,  Biuyninckx,  E)e  Schutter  and  Dutid  (1993).) 

So,  the  following  initial  situation  is  assumed:  the  position  of  ^e  three  contact  points  Surf, 
Riml  and  Rim2  is  approximately  known.  The  derivation  of  the  mathematical  model  proceeds  as 
follows.  From  the  known  geometry  of  peg  and  the  hole  (radius  =  1 0  mm;  length  =  25  mm)  and  their 
nominal  relative  position  (angle  between  both  axes,  in  this  example  9  s  0.S677  rad),  the  position  and 
orientttion  of  the  geometric  frames  {geo/uui }  and  {g^oRim}  and  the  contact  frame  {consuRp} 
(coinciding  with  {9eo5t;Af }  are  deduced  with  respect  to  a  reference  frame  attached  to  the  robot’s 
end  effector.  This  frame  is  located  at  the  top  of  the  pen  with  the  axes  parallel  to  the  axes  of  the 
geometric  frame  {geosuRp}  ^  ' 
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escribed  in  section  3.4  the  twist  Jacobians  of  each  contact 
ct-  or  geometric  frame.  From  eq.  (16) : 

eonsunr 


°’^SVRF 

0  0  0  0  -1 

0  1  0  -0.8432  0 

0  0  1  -0.5377  0 

0  -10  0  10  0 

1  0  0  0  0 

0  0  0  0  0 


From  eq.  (18) : 


jeoRrwi 


^-This  position  analysis  is  petfonned  by  modelling  the  virtual  manipulators  using  th:  .Applied  Motion'^^  software. 
-The  V  slues  of  t;.  .ri>  and  p  are  derived  from  this  analysis. 
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The  columns  of  the  Jacobians  are  numbered  according  to  the  corresponding  joints  in  the 
topological  diagram  of  figure  10.  After  the  transfonnation  to  the  end  effector  reference  frame,  the 
intersection  of  these  Jacobians  is  calculated  numerically  (Golub  and  Van  Loan,  198y).  However, 
since  at  any  time  during  the  motion,  the  Slip  and  Slide  components  of  this  intersection  are  directly 
deduced  from  the  nominal  geometric  model,  only  the  Insert  component  has  to  be  calculated 
numerically.  So,  one  ends  up  with  a  6  x  3  matrix,  in  which  each  column  describes  one  of  the  three 
degree;  of  freedom: 


0  0.0521  ■ 

0.8432  0 
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-11.8734  0 

0  0.0443 

0  0.9977 


(38) 


The  specification  of  the  desired  motion  is  then  very  simple;  multiply  each  column  with  a  scalar 
(rSKp^  ^siid^  ^jtuert^  indicating  the  desired  magnitude  of  the  corresponding  motion  component, 
and  add  these  three  twists  together. 
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The  EVOL  transformations  describing  the  current  relative  positions  of  peg  and  hole  are  easily 
updated  on  the  basis  of  the  measured  joint  motions  in  the  three  virmal  manipulators  SURF,  RIMl 
and  RIM2,  see  Eqs.(34)  and  (35).  This  is  done  using  the  evolution  Jacobians ; 


^const/HF  ~  [  *^.^1  *^52  ]  , 
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Mott'-e  that  in  this  case  the  update  procedure  remains  valid  even  for  finite  relative  displacements 
betwee.i  (iCg  and  hole  (which  maintain  the  three  point  contacts),  because  the  virtual  contact  ma¬ 
nipulators  remain  identical.  Or:  the  surfaces  of  both  objects  are  exactly  descnbed  by  second  order 
models. 


5  Conclusion 

This  paper  shows  how  to  model  contacts  between  rigid  objects  using  virtual  manipulators,  or 
kinematic  chains,  which  have  the  same  relative  degrees  of  freedom  as  the  contacting  objects  in 
the  respective  contact  points.  The  kinematic  composition  of  these  vimial  manipulators  is  derived 
from  the  first  and  second  order  geometry  of  the  contacting  surfaces  in  the  neighbourhood  of  the 
respective  contacts.  Kinematic  analogues  based  on  the  first  order  geometry  (i.e.  position  of  the 
contact  point  and  orientation  of  the  tangent  plane)  suffice  to  describe  the  instantaneous  relative 
degrees  of  freedom  between  the  contacting  objects,  but  fail  to  model  the  relative  motion  accurately 
when  the  contact  point  moves  over  the  contacting  surfaces.  On  the  other  hand,  kinematic  analogues, 
based  on  the  second  order  geometry  (i.e.  first  order  geometry  plus  curvature  information)  remain 
accurate  for  a  larger  relative  displacement  between  the  objects. 

It  is  shown  how  these  kinematic  analogues  allow  the  use  of  well  established  tools  in  kinematics 
to  specify  the  desired  motion,  and  to  analyse  the  resulting  evolution  of  the  contact  locations.  This 
approach  is  illustrated  by  means  of  tire  well  known  peg-in-hole  assembly  problem  in  case  of  a  large 
initial  misalignment 

In  force  controlled  manipulation  tasks,  also  called  compliant  motion,  the  compatibility  of  the 
specified  motion  with  the  constraints  imposed  by  the  environment  onto  the  manipulated  object 
determines  the  quality  of  the  task  execution,  both  in  case  of  passive  and  active  force  control.  So, 
this  paper  rovides  important  new  tools  to  improve  the  specification,  and  hence  the  execution,  of 
force  controlled  robotic  manipulation  tasks. 
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ABSTRACT.  Formuladons  based  on  multibody  dynamics  for  the  analysis  of  crashworthiness 
and  impact  of  vehicles  and  structural  systems  are  reviewed  in  this  paper.  A  methodology  to 
incorporate  the  elastodynamics  effecu,  suitable  to  describe  the  elastic  deformations  of 
flexible  bodies,  is  discussed.  The  limitations  of  this  methodology  for  crash  impact  are 
overcome  in  a  more  geno^  foimulation  where  the  deformation  of  the  flexible  (or  partially 
flexible)  bodies  is  described  using  an  updated  Lagrangian  formulation.  This  allows  for 
geometric  and  material  nonlinear  behavior  of  the  multibody  components.  A  major  drawbacit' 
of  this  nonlinear  formulation  is  the  inabiUty  to  describe  zones  of  concentrated  deformation 
due  to  local  insubilities.  For  this  purpose  the  plastic  hinge  concept,  where  the  structural 
plastic  deformation  is  modelled  by  nontinear  joint-spring  set-up,  is  used.  The  validity  of  this 
model  is  assessed  by  carrying  out  an  experirMntal  test  where  a  hollow  steel  extruded  beam 
collide  with  a  rigid  block.  By  p^cting  where  and  when  failure  is  likely  to  occur  using  a 
flexible  model,  the  present  technique  provides  an  efficient  tool  to  access  the  crashworthiness 
design  of  a  broad  class  of  impact  excited  structural  configurations  with  general  kinematic 
constraints.  Finally  these  methodolopes  are  applied  to  model  the  rollover  of  a  truck  in  order 
to  illustrate  their  capabilities. 


1.  Introduction 

During  the  last  twenty  five  years  computer  aided  analysis  of  crashworthiness  and  structural 
impact  has  received  a  large  attention  and  is  now  emeiging  as  a  powerful  methodology  which 
can  be  successfully  applied  in  practical  and  industrial  siniations.  in  this  paper,  multibody 
dynamics  based  meth^ologies,  applicable  to  crashworthiness  and  impact,  are  reviewed  and 
discuss^ 

Several  approaches  using  experiments  [1-4]  and/or  numerical  simulations  have  been 
adopted  in  the  past  Different  numerical  fomoulations  with  varying  degree  of  conqilexity  and 
accuracy  have  been  proposed  using  spring-mass  models  [5-9],  finite  difference  methods  [10- 
12],  and  finite  element  methodologies  [13-16].  Hybrid  approaches  [5,17,18]  utilizing  data 
obtained  from  quasi-static  crushing  of  different  segments  of  the  colliding  structure  have  also 
been  developed.  In  these  methods  the  generalized  non-linear  load-displacement 
characteristics  are  kinematically  coupled  to  the  global  structural  system  to  obtain  the  overall 
dynartuc  response  of  the  structure. 

In  some  cases  the.  experimental  load-deformation  characteristics  can  be  adjusted  to  take 
into  consideration  str^  rate  effects  [19].  The  access  to  such  experimental  data  allows  an 
insight  to  complex  phenomena  such  as  wrinkling,  friction  and  failure  of  different  connection 


elements  which  are,  in  many  occasions  difficult,  if  not  impossible,  to  obtain  in  general 
purpose  nonlinear  Hnite  element  computer  codes. 

In  standard  finite  element  formulations  the  large  displacements  and  deformations  of  the 
gross  motion  are  not  generally  taken  into  consideration.  However  recent  efforts  in  the  field  of 
nonlinear  structural  dynamics  have  contributed  for  the  development  of  well  known 
commercially  available  codes  such  as  PAM-CRASH  [20],  DYNA-3D  [21],  DYCAST  [13] 
and  WHAMS-3D  [22] .  These  programs  are  now  able  to  simulate  with  improved  accuracy 
several  different  structural  impact  phenomena  such  as  large  localized  defonmtions,  structural 
instabilities,  transient  vibiadons,  stress  wave  propagations  and  eventually  structure  course 
due  to  material  damage  and  loads  causing  stresses  above  the  ultimate  strength.  These  codes, 
however,  require  large  computer  resources  and  nonnally  involve  time  consuming  modelling 
data  preparation  which  make  them  rather  unsuitable  as  a  design  tool  during  the  initial  design 
stages. 

In  crashworthiness  and  impact  analysis  of  structural  mechanical  systems,  the  elasto- 
dynamic  effects  play  an  important  role  on  the  system  behavior.  During  the  impact  period  Ae 
deformadon  of  Ae  components  interfere  with  the  modon  of  the  system  which  results  in  a 
strong  coupling  between  the  structural  flexibilides  and  the  gross  modon  of  the  different 
components.  For  this  purpose  several  researchers  have  suggested  procedures  that 
successfully  introduce  the  elasto-dynamic  effects  into  muldbody  dynamic  fonnuladons  [23- 
25].  However,  there  are  some  unsolved  difflculdes  related  with  the  complexity  of  the 
models  obtained 

The  problems  associated  with  the  introducdon  of  flexibility  effects  in  a  muldbody 
system  are  related  with  the  complex  geometries  of  the  flexible  bodies  and  it  is  not  always 
obvious  how  to  develop  proper  and  judicious  simplified  truss  type  models  to  adequately 
represent  integrated  beam  and  sheet  metal  structural  components.  Basically  this  area  deals 
with  the  understanding  o^  the  failure  and  collapse  mechanic  based  on  expoimental  results 
which  makes  possible  to  tune  accurate  and  cost  effecdve  siiiqilified  analydw  techniques. 

In  many  impact  situations,  the  individual  structural  members  are  overloaded  principally 
in  bending  giying  rise  to  plasdc  deformadons  in  highly  localized  regions,  called  plasdc 
hinges.  These  hinges  occur  at  points  of  maximum  bending  moments,  at  load  applicadon 
points,  at  joints  and  in  locally  weak  areas.  If  the  levels  of  plasdc  deformadon  are  large,  a 
plasdc  hinge  allows  leladve  rotadon  between  the  parts  of  the  structure  and  it  becomes 
reasonable  to  model  these  phenomena  within  the  franiework  of  rigid-flexible  body  dynamics 
fonnuladons.  For  complex  cross  secdons  and  joints  the  plasdc  behavior  is  more  complex 
involving  local  buckling  and  eventually  fracture  which  can  only  be  accurately  predicted  by 
simple  and  cheap  tesu  on  localized  parts  of  the  snucture  [26]. 

In  this  paper  a  muldbody  dynamic  formuladon  for  systems  with  linear  and  nonlinear 
structural  deformadons  is  reviewed  and  the  plasdc-hinge  i^elling  approach  as  ^lied  to  a 
rigid-flexible  muldbody  system  is  presented.  These  flexibility  effects,  which  may  be 
important  during  the  impact  period,  can  be  taken  in  consideradon  with  the  present 
fonnuladon.  The  exanqile  of  a  rotating  beam  is  presented  to  illustrate  the  effect  of  geometric 
nonlinear  deformadons  on  the  system  components.  A  colliding  beam  example  is  analyzed 
and  a  corresponding  experimental  test  is  carried  out  to  assess  the  validity  of  the  proposed 
fonnuladon.  Finally,  these  methodologies  are  applied  to  the  rollover  and  crashworthiness  of 
an  utility  truck. 


2.  Multibody  Dynamics  Using  Joint  Coordinates 

A  muldbody  system  is  a  collection  of  rigid  and  flexible  bodies  joined  together  by  kinemadc 
joints  and  force  elements  as  depicted  in  Figure  1.  For  the  body  in  the  system  q;  denotes  a 
vector  of  coordinates  which  contains  the  Cartesian  transladonai  coordinates  ri,  a  set  of 

rotanonal  coordinates  Pi.  and  a  set  of  nodal  coordinates  qf,  u'  or  S'  (if  body  i  is  flexible).  A 
vector  of  velocities  for  a  rigid  body  <  is  defined  as  Vi,  which  contains  a  3-vector  of 
translational  velocities  f,  and  a  3-vector  of  angular  velocities  (defined  in  the  XYZ 
coordinate  system).  If  body  i  is  flexible  then  the  vector  of  velocides  v;  contains  f,  , 
(deSned  in  the  coordinate  system)  and  a  vectcv  of  nodal  velocides  q|  or  S'.  The  vector 
of  acceleradons  for  the  body  is  denoted  by  and  it  is  simply  the  time  detivadve  of  v,.  For 
a  muldbody  system  containing  nb  bo^es,  the  vectors  of  coordinates,  velocides,  and 
acceleradons  are  q,  v  and  v  which  contain  the  elements  of  qi,  v;  and  v,,  respecdvely,  for 
i=l . nb. 

Spherical 


Revolute 


Spring  force 

External 

Figure  1  Schemadc  representadon  of  a  muldbody  system 

Let  the  kinemadc  joints  between  rigid  bodies  be  described  by  mr  independent 
constraints  as 

<b(<l)  =  0  (1) 

The  first  and  second  derivatives  of  the  constraints  yield  the  kinemadc  velocity  and 
acceleradon  equadons. 


O  *  Dv  =  0 
<t)sDv+Dv  =  0 


(2) 

(3) 


where  0  is  the  Jacobian  matrix  of  the  constraints.  The  equation  of  motion  for  the  system  of  ! 

rigid  bodies  are  written  (see  reference  [27])  | 

Mv-DU=g  (4)  I 

where  M  is  the  inertia  matrix,  X  is  a  vector  of  Lagrange  multipliers,  and  g  =  g(q,  v)  contains  \ 

the  forces  and  moments  that  act  on  the  bodies,  and  the  gyroscopic  terms.  I 

The  constrained  equadons  of  motion  expressed  by  equations  (1)  to  (4)  can  be  convened  \ 

to  a  smaller  set  of  equations  in  terms  of  a  set  of  coordinates  known  as  joint  coordinates.  ! 

Such  transformation  is  Iviefly  discussed  here  (for  more  details  refer  to  reference  [27]).  The  1 

relative  configurations  of  two  adjacent  bodies  are  described  by  a  set  of  relative  coordinates,  ’ 

equal  to  the  number  of  relative  degrees  of  freedom  between  the  bodies.  The  vector  of  joint 

coordinates  for  a  system  of  rigid  bodies  is  denoted  by  P  and  it  contains  all  the  joint 

coordinates  and  the  absolute  coordinates  of  the  floating  base  bodies.  The  vector  of  joint  i 

velocities,  defined  as  is  the  time  derivative  of  P,  being  its  relation  with  v  is  given  by  [27] . 


v  =  B/j  (5) 

where  matrix  B  is  the  velocity  transformation  matrix  and  can  be  shown  to  be  orthogonal  to 

the  Jacobian  matrix  D.  The  transformation  of  the  accelerations  is  obtained  by  deriving  ^ 

equation  (5)  with  respect  to  time.  This  is  written  as  i 

v-Bp  +  Bp  (6) 

Substituting  equation  (6)  into  equation  (4),  premultiplying  by  B^,  and  using  the 
orthogonality  condition  between  B  and  D  yield 

MP  =  f  (7) 

where  ; 
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3.  Flexible  Multibody  Dynamics 

For  the  crashworthiness  and  impactanalysis,  using  a  multibody  formalism,  the  description  of 
the  flexibility  of  its  components  may  necessary.  The  behavior  of  systems  subjected  to 
impact  is  characterized  by  zones  of  large  deformations  and  by  zones  where  only  elastic 
deformations  take  place.  For  the  purpose  of  describing  this  behavior,  linear  and  nonlinear 
formulations  of  multibody  systems  are  reviewed  in  this  section. 

3.1.  LINEAR  DEFORMATIONS 

It  has  been  shown  [25,29]  that  the  configuration  of  a  deformable  body  in  a  multibody  system 
can  be  described  by  a  set  of  global  reference  coordinates  qr‘  and  local  elastic  coon^tes  u‘ 
which  are  defined  using  the  finite  element  methodology.  As  shown  in  figure  2,  the  position 
of  a  flexible  body  in  the  non-moving  reference  frame  is  specified  by  the  spatial  location 

fi  of  a  body  fixed  frame  &  set  of  angular  orientation  coordinates  4>‘ ,  thus  the 

coordinates  describing  the  gross  motion  of  the  body  are  *  [r*^,^'^]. 


t 

\ 

\ 

1 

I 

i 


Using  the  Hnite  element  method  to  describe  the  flexibility  of  body  i ,  the  kinetic  energy  T>  is  a 
function  of  q‘  and  and  the  elastic  energy  U'  is  function  of  q‘.  The  equations  of  motion 
(10)  for  body  i  take  the  form  [24,25,29,30] 

M‘(q‘)q‘  +  K‘  q‘ =  g‘(q‘,q‘.r)+s‘{q‘,q‘)  (11) 

where  K>  are  the  mass  and  stiffness  matrices  of  body  i,  respectively,  g*  is  the  vector  of 
generalized  forces  of  body  i,  s‘  is  a  vector  containing  velocity  quadratic  terms  and  other 
acceleration  independent  terms.  In  a  less  compact  form,  equation  (1 1)  is  written  as: 


M„  ® 

My  +  0  0  0 


_M^  M,,  M^JLu' 


0  0  K 


8#  - 

.8/J  L®/. 


In  this  equation  the  submatrices  M^,  Mr^  and  ,  associated  with  the  gross  motion 

of  the  boidy*fixed  coordinate  frame,  and  Mjjjr,  the  standard  finite  element  mass  matrix,  are 
time  invariant  Assuming  small  linear  elastic  ^formations  for  the  flexible  body,  the  stifihess 
matrix  K  is  also  constant  The  remaining  terms  of  the  mass  matrix  are  time  variant  and  must 
be  calculated  every  time  step.  The  mean  axis  conditions  can  be  applied  to  equation  (12) 
resulting  in  a  constant  mass  matrix  where  the  inertia  coupling  between  rigid  and  flexible 
de^es  of  freedom  disapears  [29,30].  Another  methodology  to  transform  the  mass  matrix 
M>  into  a  diagonal  constant  matrix  is  discussed  in  the  next  section. 

3.2.  EQUATIONS  OF  MOTION  FOR  CONSTRAINED  FLEXIBLE  BODY 


Consider  now  a  mechanical  system  with  nb  bodies  connected  by  joints  which  are  described 
by  m  holonomic  constraints  in  the  form 

<I>(q,t)=0  (13) 

where  <I>(q,t)  =  [<I>i(q,t)T,..,.  ,<l>n,(q.t)'*']T,  These  equations  express  the  dependency 
between  the  genei^zed  cartesian  coorc^tes  q. 

Consider,  for  example,  two  bcxiies  i  and  J  connected  through  a  revolute  joint  in  a 
common  point  k,  as  illustrate  in  figure  3.  The  vectorial  equation  which  forces  point  k  to  be 
coincident  in  both  bodies  at  all  times  is  written  in  the  form 

r‘  +  AV-r'-AV^  =  0  (14) 

where  b'^  b'J  are  {wsition  vectors  of  point  k  in  bodies  i  and  /  resi>ectively;  A*,  AJ  are 
transformation  matrices  fram  the  body  cooi^nate  systems  to  the  global  inertia  frame. 

This  joint  has  two  algebraic  constraint  equations.  If  both  bodies  are  flexible  b'^  b'J 
depend  on  the  generalized  elastic  coordinates,  implying  that  these  vectors  have  to  be 
calculated  at  each  time  for  the  current  deformation  state.  Then 


I 


r‘  +  A‘(b'‘  +  5l)-r>-  A'(bi'  +  5')  =  0 


(15) 


where  b'o‘>  b'oi  correspond  to  the  position  vectors  of  point  k  in  the  undeformable  state,  5|cS 

S|cJ  are  the  flexible  displacements  of  the  connection  node  (point  k)  of  bodies  i  and  j, 
respectively. 


The  holonomic  kinematic  constraints  are  introduced  in  the  variational  form  of  the 
equations  of  motion  of  body  i  using  Lagr^ge  multipliers.  After  substimting  all  energy 
expressions  in  these  equations,  the  dynamic  equations  of  motion  for  a  flexible  body  are 
written  in  a  compact  foim  as: 

M-(q‘)q‘  +  D'A  =  g‘(q‘.q‘,t)+s'(q‘,q‘)-K‘  q‘  (16) 

where  D  =  (d4>/ dq' )  is  the  Jacobian  matrix  for  the  constraints. 

Once  these  equations  have  been  obtained  for  each  body,  it  is  necessary  to  assemble  the 
equations  for  all  t^es  of  the  mechanical  system.  For  the  equations  obtained,  the  angular 
acceleration  of  the  body  fixed  coordinate  fr^e  must  be  trannormed  to  global  components 
such  that  the  accelerations  in  equation  (1 1)  are  consistent  with  the  rigid  body  accelerations 
used  in  the  transformations  of  the  joint  coordinate  method,  expressed  by  equations  (S).  The 
constraint  equations  and  their  corresponding  Lagrange  multipliers  can  be  eliminated  from  the 
equations  of  motion  by  using  velocity  transformations.  The  interested  reader  is  directed  to 
references  [31,32]  for  a  more  detailed  discussion  on  the  use  of  the  joint  co-ordinate  method 
with  flexible  b^es. 

3.3.  GEOMETEUC  AND  MATIERIAL  NONLINEAR  DEFORMATIONS 

The  description  of  the  deformation  of  the  flexible  body  i  presented  before  is  not  suitable,  by 
itself,  to  applications  where  the  nonlinear  deformations  play  a  major  role  in  the  dynamics  of 
the  multibody  sy.<!tem.  This  is  the  case  of  applications  involving  the  impact  and 
crashwonhiness  of  vehicles.  In  order  to  overcome  these  limitations,  a  more  generd 
formulation  of  a  flexible  body  was  proposed  by  Ambrdsio  and  Nikr.»vcsh  [33].  In  this 
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methcxiology  an  updated  Lagr^gian  fonnulation  is  used  to  describe  the  Idnencs  of  the 
flexible  body.  Moreover,  the  finite  element  method  is  used  to  represent  the  flexible  body. 

The  kinetic  energy,  deformation  energy  and  external  forces  are  calculated  using  the 
updated  Lagrangian  formulation.  Using  equation  (10)  for  each  finite  element  and  assembling 
their  contributions  leads  to  the  flexible  body  equations  of  motion  written  as: 

M„  M,,  Mrf  ’f'  ’g,"  fs,!  rol  fO  0  0  To' 

M,,  =  g;  -  s;  -  0  -  0  0  0  0  (17) 

_M^  M„  mJu'J  [g;J  [s;J  [.‘.fJ  [o  o 

In  this  equations  the  left  superscripts  are  referred  to  the  configuration  in  which  an  event 
occurs  while  a  left  subscripts  refer  the  configuration  in  which  &e  event  is  measured.  The 
configurations  in  wUch  an  event  cm  occur  or  be  measured  are:  the  current  configuration;  the 
last  known  equilibrium  configuration;  and  the  initial  configuration,  respectively  denoted  by 

t+At,  t  and  0.  For  instance,  vector  ,',F  denotes  the  nodal  forces  equivalent  to  the  acmal  state 
of  sttess  that  occur  in  the  reference  configuration  t  and  are  measured  in  a  corotated 
configurauen  t'.  Vector  u'  denotes  the  increments  of  displacements  from  the  updated 
configuration  to  the  current  configuration  due  to  the  increment^  nature  of  this  formulation. 

In  equation  (17)  the  mass  matrix  is  equal  to  the  mass  matrix  calculated  for  equation 
(12),  the  right-hand  side  is  composed  by  a  vector  of  externally  applic  genoalized  forces,  a 
vector  of  gyroscopic  forces,  and  internal  forces  due  to  the  defomoation  of  the  flexible  body. 
The  vector  of  the  external  applied  generalized  forces  is  evaluated  over  the  updated 
configutatio.n  and  it  is  written  as: 


‘'da+J  V  '*%  ‘'dv 

'A  ‘V 

,-g=  ''da+J®p6'AT‘*X‘'dv  (18) 

‘A  ‘"V 

J  '*“f,  ‘'da+  J  VN^A""  ''dv 

.‘‘a  '"V 

where  A  is  the  transformation  matrix  from  the  body  fixed  coordinate  system  to  the  inertial 
fiarae,  N  is  the  matrix  of  shape  functions,  and  are  the  body  and  surface  forces 
respectively.  The  vector  of  gyroscopic  forces  is  written  as: 


In  equation  (17)  matrices  .!K^  and  ,‘.K^  are  respectively  the  linear  and  nonlinear 

stiffness  matrices,  and  ,!F  denotes  the  vector  of  equivalent  nodal  forces  due  to  the  actual 
state  of  stress.  These  quandoes  are  given  by: 


X  =  .CX  ‘  dv 

(20) 

t'®NL  i'®NL  *dV 

(21) 

(22) 

■•v 


In  these  equations  ,18^  and  denote  the  linear  and  nonlinear  strain  matrices, 
respectively,  and  X  is  the  Cauchy  stress  tensor  for  the  updated  configuradon.  It  should  be 
noted  that  the  reference  to  the  linearity  of  the  sdffiiess  matrices  and  is  related  to 
their  reladon  with  the  displacements.  If  the  consdtudve  tensor  ^,C  is  not  constant  then  both 
,!Kt,  and  are  not  linear. 

A  muldbody  system  may  experience  elasto-plasdc  deformadons  of  one  at  more  of  its 
components.  For  these  problems,  an  elasto-plasdc  consdtudve  tensor  ,.C  must  be  used  in 
the  e^uadon  (20).  I^tropic  hardening  and  isothermal  condidons  can  be  assumed  for  the 
descripdoo  of  this  tensor .  The  material  yield  condidon  is  written  as; 

f^‘'T,‘')cj  =  0  (23) 


where  '  r  is  the  Cauchy  stress  tensor  and  '  V  is  the  hardening  parameter  (which  is  a  fiincdon 
of  the  state  of  strain).  Yielding  occurs  when  equadon  (23)  is  sadsded.  Any  further  strain 
increment  will  be  partially  elasdc  and  pardally  plastic.  These  strain  increments  are  related 
with  the  total  strain  inctement 


d  ^,e  =  d  ,,e'+d  ^,e^ 


(24) 


Furthermore,  let  associated  plasdcity  be  assumed.  In  these  condidons  Ziencldewicz  [34] 
shows  that  the  form  of  the  elasto-plasdc  consdtudve  tensor  is  given  by 
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where  is  the  elasdc  consdtudve  tensor.  The  parameter  H  is  the  slope  of  the  plot  of  tte 
stress  versus  plasdc  strain  for  the  uniaxial  test  if  the  Huber- Von  Mises  surface  is  used  in 
equadon  (23). 


3.4.  PARTIALLY  FLEXIBLE  BODY 


^uadon  (17)  desciibes  thoroughly  the  modon  of  a  flexible  body.  However  the  fonn 
of  this  equadon  is  not  efficient  for  numerical  implementation  because  not  only  ail  the 
quanddes  of  the  right-hand  side  are  not  constant  but  also  the  mass  matrix  is  variant.  A 
simpler  form  of  the  equadons  of  modon  for  a  flexible  body  is  obtained  if  a  lumped  mass 
formuladon  is  used  and  the  accelerations  ii'  are  subsdtuted  by  a  vector  of  nodal  acceleradons 
reladve  to  the  nonmoving  reference  dame  ql  [23]. 

The  vecton  of  nodal  acceleradons  can  be  parddoncii  into  transladonal  and  angular 
acceleradons  as: 


The  reladon  between  the  reladve  and  absolute  nodal  acceleradons  for  a  node  k  is  described 
by: 


d'' 

A"  -{x^  +  l‘)'|"' 

(i»'m'(x‘‘+5*/+2w'{5') 

k 

a\ 

k 

(26) 


where  is  the  posidon  of  node  k  in  the  reference  configt^on.  Equadon  (26)  is  evaluated 
for  nodes  of  body  i  and  subsdtuted  into  equadon  (17)  yielding 


(27a) 

(27b) 

(27c) 


Equadons  (27a)  and  (27b)  are  the  equadons  of  modon  for  the  center  of  mass  of  a  system  of 
tardcles  [35].  Equadon  (27c)  is  the  equadon  of  modon  for  the  nodes  of  the  flexible  body, 
expressed  in  the  body  fix^  coorr/nate  system.  Note  that  due  to  the  use  of  the  lumped  noass 
formuladoi:  the  mass  matrix  M ff  is  diagonal  and  written  as: 


Mff  =  Diag(mil,0,”-,m  J,0,— ,m„I,0) 

where  mic  is  the  lumped  mass  of  node  i;,  and  I  and  0  are  3x3  idendty  and  null  matrices 
associated  with  the  transladonal  and  rotadonal  degrees  of  freedom,  respecdvely. 

If  the  origin  of  the  body  fixed  coordinate  system  is  coincident  with  the  center  of  mass  of 
the  flexible  bray,  equadons  (27a)  and  (27b)  are  the  equadons  of  modon  of  the  origin  of  the 
refercnciaL  Very  often  it  is  useful  to  locate  the  origin  in  some  other  pcLit  of  the  flexible 
body.  For  this  purpose  let  it  be  assumed  that  the  flexible  body  has  one  rigid  part  and  one 
flexible  part  Let  the  body  fixed  coordinate  frame  be  attached  to  the  center  of  mass  of  the 


rigid  part  as  shown  in  figure  4.  The  flexible  pan  is  attached  to  the  rigid  pan  by  the  nodes 
that  belong  to  boundary  vy.  The  body-fixed  coordinate  frame  is  the  same  for  the  rigid  and 
flexible  domains. 


i 


Cuirent  Configuration 


The  Newton-Euler  equadons  of  morion  for  a  rigid  body  are  written  as 

mf  =  f  (28a) 

(28b) 

where  f  and  n  are  the  external  forces  and  moments  applied  over  the  center  of  mass  of  the 
rigid  pan  of  the  body.  Equations  (28r.)  and  (28b)  can  be  used  instead  of  (27a)  and  (27b) 
provided  that  proper  Idnemaric  constraints  are  introduced  between  the  flexible  and  rigid  parts 

of  the  body.  These  idnemaric  constraints,  that  only  affect  the  nodes  in  the  boundary  y,  are 
described  by: 

5'  =  5'=5'  =  0'  =  e'=0'  =  O  (29) 

The  constraint  equations  can  be  applied  to  the  equation  (26)  for  each  of  the  boundary  nodes 
using  the  Lagrange  multiplier  technique.  At  a  latter  step  ^ese  mulripliers  are  eliminated  from 
the  equations  of  morion  resulting  in  the  dynamic  equations  [23] 
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where  M*  is  a  diagonal  mass  matrix  containing  the  mass  of  the  a  boundary  nodes.  Matrices 
A^,S  and  I  are  made  riom  (3x3)  matrices  as: 


V 

A^ 

:  S  = 

(x'+5‘/ 

;  1= 

r 
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\\ 
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(x“-t-5‘>) 

I 

Vectors  C ^  and  C',  represent  respectively  the  reaction  force  and  moment  of  the  flexible  part 
of  the  body  over  the  rigid  part  'ITiese  reaction  forccAnomcnts  are  wrinen  as 


Ci 

c; 


(31) 

(32) 


In  these  equations  the  subscripts  ^  and  d  refer  to  the  partition  of  the  vectors  and  matrices 
with  respect  to  the  translational  and  rotational  nodal  degrees  of  hreedom.  The  underlined 
subscripts  are  referred  to  the  boundary  nodes  between  the  rigid  and  flexible  pans. 

Equation  (30)  is  the  finite  element  equation  of  motion  for  a  flexible  body.  When  finite 
elements  with  rotational  degrees  of  freedom  are  used  to  discretize  the  flexible  body,  some 
null  elements  appear  in  the  diagonal  of  the  mass  submatrix  .  Therefore  equation  (30) 
cannot  be  solved  explicitly  for  the  accelerations.  Three  approaches  can  be  used  to  solve  this 
problem.  In  the  frrst  tqtpioach  rotational  inertias  obtained  by  lumping  the  off-diagonal  terms 
of  the  consistent  mass  matrix  M,;  are  used  to  replace  the  null  coefficients.  In  the  second 
approach  a  static  condensation  of  the  nodal  rotational  degr^  of  freedom  is  used.  In  a  third 
approach  the  modal  superposition  technique  is  used  to  eliminate  the  explicit  use  of  nodal 
rotations  In  what  follows,  any  reference  to  the  use  of  equation  (30)  implies  the  use  of  the 
first  approach.  The  second  and  third  approaches  are  d»cussed  next. 

3.5.  STATIC  CONDENSATION  OF  NODAL  ROTATIONS 

In  order  to  use  the  static  condensation  of  the  routional  de^es  of  freedom  let  the  nodal 
equations  of  motion  be  partitioned  into  translational  and  rotational  degrees  of  freedom.  The 
relation  oetween  the  translational  degrees  of  freedom  and  the  rotational  coordinates  is 
described  by 


(33) 

Applying  equation  (33)  to  equation  (30)  results  in  the  equations  of  motion  of  the  reduced 
system,  i.e.,  without  the  explicit  use  of  the  rotational  de^ees  of  freedom.  These  equations 
are  written  as: 
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By  a  proper  choice  for  the  location  and  orientation  of  the  body  fixed  coordinate  system 
in  the  rigid  part  of  the  flexible  body,  the  mass  matrix  in  cquadons  (30)  and  (34)  is  lum^  into 
a  diagonal  invariant  matrix.  For  this  purpose  the  position  of  its  origin  must  be  coincident 
with  the  center  of  the  system  of  masses  composed  by  the  rigid  pan  and  the  boundary  nodes 
•J  the  flexible  pan  of  the  body.  Furthermore  the  coordinate  system  must  be  aligned  with  the 
principal  directions  of  inertia  of  the  rigid  pan  plus  boundary  nodes. 

3.6.  MODAL  SUPERPOSITION  TECHNIQUE 

In  order  to  achieve  compuutional  efficiency  in  the  solution  of  the  flexible  body  equations  of 
modon,  the  modal  superposidon  technique  has  been  widely  used  [24,29].  llus  method  is 
well  suited  to  reduce  the  number  of  degrees  of  freedom  of  a  flexible  body  when  the  mass  and 
stiffness  matrix  are  dme  invariants  and  the  frequency  contents  of  the  external  applied  forces 
are  of  the  same  order  as  the  lower  natural  frequencies  of  the  flexible  body.  This  procedure 
can  sdll  be  applied  for  cases  where  the  stiffness  matrix  shows  some  level  of  nonlinearity. 
Assume  that  the  sdffhess  matrix  is  decomposed  into  an  invariant  matrix  and  a  displacement 
dependent  matrix.  For  cases  where  the  material  consdtudve  tensor  is  constant  (linear  elasdc 

material)  the  constant  stiffness  matrix  is  while  the  displacement  dependent  matrix  is 
,!Knl.  Moreover,  assume  that  the  first  two  rows  of  equation  (30)  or  equadon  (34)  have 
been  solved  for  r  and  m'. 

Subsdtudng  the  reladon  between  the  global  nodal  acceleradons  and  the  nodal 
acceleradons  teladve  to  the  body  fixed  coordinate  system,  given  by  equadon  (26),  into  the 
third  row  of  equadon  (30)  gives 


(35) 


where  vector  represents  the  inertia  forces  due  to  the  substitudon  of  global  nodal 
acceleradons  by  local  acceleradons.  This  vector  is  written  as: 


f.= 


M*(Ff-S<y'-Wj-2W,5j 
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(36) 


Here  W,  and  Wj  are  represented  by 
W,  =  Diag(d)'.0',-.Gj') 
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The  solution  of  the  eigenproblem,  posed  by  equating  the  right-hand  side  of  equation 
(3S)  to  zero,  is  a  set  of  natural  frequencies  and  corresponding  modes  of  vibration  for  the 
flexible  body.  The  nodal  displacements  can  be  expressed  as  a  linear  combination  of  the 
modes  of  vibration,  i.e. 

'u'  =  X2  (37) 

where  X  is  the  modal  matrix.  The  number  of  modes  of  vibration  envolved  in  equation  (34) 
is  nm  which  is  normally  much  smaller  than  the  number  of  nodal  degrees  of  freedom  of  the 
flexible  body.  Once  the  modes  of  vibration  are  not  time  dependent,  the  modal  accelerations 
and  velocities  are  given  by 

u'sXz  (38) 

u'  =  X2  (39) 

Equations  (37)  through  (39)  are  now  substituted  into  equation  (35)  and  the  result  pre¬ 
multiplied  by  XT.  Using  the  property  of  otthonormality  of  the  modal  matrix  with  the  mass 
matrix  it  is  found  that 

w  =  X"(g;-,:F-;K«,u'-  f.)- Aw  (40) 

where  A  is  a  diagonal  matrix  with  the  squares  of  the  natural  firequencies.  Equation  (40)  is 
the  modal  ^nation  of  motion  for  the  flexible  body.  The  complete  set  of  equations  of  motion 
for  the  flexible  body  is  composed  by  the  two  first  rows  of  equation  (30)  and  equation  (40). 

3.7.  APPLICATION  TO  A  ROTATING  BEAM 

The  problem  of  a  canteliver  beam  attached  to  a  rigid  hub,  which  is  spun  up  from  rest  to  a 
constant  angular  speed,  is  analyzed  here.  This  problem,  first  proposed  by  K^e  et  al.  [36]  is 
snidied  in  order  to  show  the  performance  of  the  methodologies  present^  namely  to  show 
the  difference  between  the  application  of  the  different  types  of  coordinates  used  to  describe 
the  deformations  of  the  flexible  body. 

The  canteliver  beam,  with  a  lenght  of  10  meter  and  aimular  cross  section  is  presented  in 
figure  S.  The  angular  spe«i  of  the  hub  is  a  function  of  time  prescribed  as; 

6  rad/s  t2l5 
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The  results  presented  in  figure  6  show  that  if  a  linear  behavior  is  assumed  for  the  beam, 
i.e.,  the  geometric  stiffness  is  neglected  and  the  defonnations  are  small,  the  tip  displacement 
of  the  beam  with  respect  to  the  body  fixed  coordinates  becomes  infinite  after  7  seconds  of 
simulation.  If  equadon  (34)  is  used  to  represent  the  flexible  body,  the  results  are  similar  to 
those  obtained  by  Kane  et  al.,  and  the  tip  displacement  increases  while  the  angular 
acceleradon  of  the  hub  is  increasing.  The  dp  of  the  beam  ends  up  oscillating  about  its 
undeformed  posidon  after  the  angular  speed  becomes  constant 


Bgure  6  In  plane  displacement  of  the  dp  of  the  rotating  beam 
with  respect  to  the  undeiformed  posidon 
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_ different  types  of  equations  of  motion  are  referred  here  as:  equations  with  no 

coo^nate  redMOon  (30);  stancally  condensed  equations  (34);  and  nSlal  equations  of 
motion  (40).  .^en  a  Unear  behavior  for  the  beam  was  assumed  all  forms  of  the  MiSom  S 
motion  provnded  the  same  behavior.  When  the  beam  was  allowed  to  show  a  Geometric 
noitiinear  behavio^the  solution  of  the  equations  of  motion  based  in  the  mo<^  supenx>sition 
had  an  error  of  10%  rclaave  to  the  results  obtaini^  with  the  equations  of  motion  with  static 
condensation  or  with  no  coordinate  reduction. 

4.  Concentrated  Deformations  >  Plastic  Hinges 

The  plastic  hinge  concept  has  been  previously  developed  by  utilizing  snrina 

clenwnts  to  reprint  constitutive  characteristics  of  localized  plastic  deformation  of  baxos 
Bending  p^asoc  deformanon  at  an  attachment  node  has  been  modeUed  by  revolute  joints  as 


T“  ^  I 

/fil  attachment 


Hgure  7.  Plastic  Hinge  concept 

.-j  T*'*  revolute  joint  must  be  simultaneously  peipendicular  to  the  neutral  axis  of  the  beam 
written  **  P  bendmg  plane.  From  figure  6  the  following  relationship  can  be 

eii*9i+£,i-0j.e,j  (41) 

which  shows  the  dependency  of  the  plastic  hinge  angle  on  the  rigid  body  positions  and  on 
me  el«tic  rotations  of  body  /  and  bodyy  at  the  attachment  node  k.  The  angle  values  are 
directly  obtained  as  relative  coordinates  froru  the  integration  process  and  correspond  to  me 

relative  degree  of  freedom,  0ij,  of  me  revolute  joint  under  consideration. 

K^e  8  illustrates  a  tj^ical  torque-angle  constitutive  relationship  which  has  been 
obtained  in  an  earlier  work  [37]  for  the  case  of  a  steel  tubular  cross  section  based  on  a 


kinematic  folding  model  [3S).  This  model  was  modified  to  take  into  account  elastic  plastic 
material  properdes  including  strain  hardening. 

The  plastic  hinge  modelling  technique  generally  requires  that  the  spring  data  must  be 
multiplied  by  a  dynamic  correction  factor.  Currently,  the  formula  suggested  by  Winmer  [39] 


Pd/Ps=  1+0.07  Vo-82 


(42) 


has  been  used  where  Pd  and  Ps  are  the  dynamic  and  static  forces,  respectively,  and  Vq  is  the 
impact  veloci^.  This  equation  may  not  be  valid  for  a  wide  range  of  cross  sections.  Its  only 
advantage  resides  in  its  generality  for  accounting  strain  rate  effects.  The  user,  however,  may 
be  able  to  incorporate  other  conection  factors. 
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Figure  8.  Plastic  Hinge  constimtive  relations.hip 
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4. 1 .  EXAMPLE  OF  AN  IMPACTING  BEAM 

The  foimulations  for  rigid  and  flexible  body  dynamics  including  the  plastic  hinge  model  have 
been  implemented  in  a  computer  program.  In  order  to  verify  the  proposed  analytical 
technique  a  comparison  with  an  expeiiirrental  test  [40,41]  was  carried  out 

The  experimental  set  up  for  this  te.st  case  and  the  test  specimen  are  shown  in  figure  9. 
The  test  bar  is  an  E36  steel  box-beam  tube,  1  m  long,  with  a  50x25  mm  hollow  rectangular 
section  and  2.65  mm  thick.  One  of  the  bar’s  ends  is  articulated  to  the  ground  structure  ivith  a 
revolute  joint  which  is  realized  by  means  of  a  coupling  sleeve  allowing  the  rotation  of  the  bar 
around  an  hmizontal  axis.  A  ballasting  mass  of  5.95  kg  is  attached  to  the  other  end  of  the 
bar.  This  mass  is  mode  of  an  XC38  steel  cube  90.5mm  Tong. 

Tlie  test  procedure  is  similar  to  the  pendulum  ram  impact  test  The  bar  is  accelerated  by 
means  of  a  fast  cylinder  which  actuates  until  an  angular  velocity  of  1 1.85  rad/s  is  reached. 
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After  stabilization  of  the  velocity,  the  bar  collides  with  a  rigid  block.  The  edge  of  this  rigid 
block  is  transverse  to  the  beam  lon^tudinai  axis  and  located  at  a  distance  of  0.S  m  away  tom 
the  axis  of  the  revolute  joinL  During  the  impact,  accelerations  have  been  measured  using 
accelerometers  which  were  implant^  on  the  ballasdng  mass.  A  post  impact  observation 
clearly  indicates  the  existence  of  a  localized  plastic  bending  zone  which  supports  the 
consideration  of  a  plastic  hinge  and  a  final  value  of  the  permanent  bending  angle  was 
measured  and  was  found  to  be  22°. 


Figure  9  Experimental  configuration 


A  series  of  computer  simulations  have  been  performed  for  the  analysis  of  the  impacting 
beam  referred  to  above.  Different  rigid  and  tigid-fiexible  models  have  b^n  considered  which 
are  shown  schematically  in  figure  10. 

Two  rigid  models  with  two  and  four  bodies  and  two  and  four  revolute  joints 
lespecdveiy;  and  two  flexible  models  with  the  same  topology  of  the  rigid  body  cases.  Plastic 
hinges  have  been  assumed  in  all  intermediate  revolute  joints.  Each  flexible  body  was 
discretized  with  one  finite  element  across  and  with  extreme  nodes  located  in  the  revolute 
joints  and  in  the  ballasting  mass.  A  translational  penalty  spring  with  a  very  high  stiffness 
was  included  to  represent  the  unilateral  contact  between  the  beam  and  the  impacted  edge. 
This  spring  actuates  only  in  the  compression  stage.  During  the  initial  stages,  before  contact, 
and  in  the  final  rebound  phase  this  spring  element  is  stretched  and  no  force  is  considered. 

Figure  1 1  illustrates  a  set^uence  of  computer  generated  positions  for  the  two  rigid  body 
model  during  the  simulation  time.  The  predicted  gross  motion  shows  a  similar  trend  when 
compared  with  high  speed  photographs.  An  a-sscssment  of  the  accuracy  of  the  theoretical 
models  is  made  on  the  basis  of  the  results  obtained  for  the  permanent  bending  angles.  This 
is  justified  as  the  final  configuration  of  the  beam  is  strongly  dependant  on  the  dynamics  of 
the  problem  and  also  on  the  mechanisms  of  energy  absorption.  The  measured  and  calculated 
final  bending  angles  are  summarized  in  the  table  1.  An  excellent  agreement  can  be  observed 
when  comparing  the  experimental  value  with  the  different  numerical  simulations. 


Figure  10.  Multibody  models 
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Hguie  1 1.  Evolution  of  the  bending  angle.  Rigid  body  model 


Table  1.  Comparison  of  Results 
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5.  Kinetostatic  Method 

For  some  applications  of  the  crashworthiness  analysis,  the  mass  of  the  deformable  part  of 
the  flewble  is  relatively  small  compared  to  that  of  the  rigid  part  This  may  happen 
when  the  deformable  part  is  a  layer  around  the  rigid  body  or  a  flexible  appendage.  This 
concept  is  illustrated  in  figure  12  for  the  rollover  of  a  vehicle  where  the  flexible  part  is 
designated  by  x- 


Figure  12  Schematic  representation  of  the  rollover  of  a  vehicle  with  a  rollbar 
cage:  (a)  Global  dsplacement  of  the  vehicle;  (b)  Deformation  of  the 
rollbu  cage  during  impact;  (c)  Force/Moment  reaction  over  the 
chassis  due  to  structural  deformations. 
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In  this  methcxl,  the  following  as£u^>ptions  are  made:  the  mass  and  moments  of  inertia 
of  the  structure  can  be  neglected  when  compared  with  that  of  the  rigid  body;  the  mass  and 
moments  of  inertia  of  the  rigid  pan  include  that  of  the  flexible  part:  the  deformation  of  the 
flexible  pan  does  not  change  the  inertial  characteristics  of  the  body. 

For  simplicity  of  notation,  the  deformable  pan  of  the  flexible  body  is  here  designated  by 
"the  structure"  while  the  rigid  pan  of  the  same  body  is  referred  to  as  "rigid  body  i".  It  is 
assumed  that  the  material  consdtudve  law  for  the  structure  is  linear  elasdc;  the  deformadons 
are  small:  no  other  fence  besides  the  reacdon  forces  from  impact  is  applied  over  the  structure. 

The  equations  of  motion  for  a  rigid/flexible  body  are  given  by  equations  (30).  The  rigid 
and  flexible  equations  are  numerically  uncoupled.  In  the  right  hand  side,  the  action^reaction 
forces  between  the  flexible  and  the  rigid  pan  are  accounted  for.  Using  the  assumption  of  a 
massless  structure  for  the  flexible  equations  of  motion,  all  of  the  nodal  masses  are 
eliminated.  In  order  to  maintain  the  total  mass  of  the  rigid/flexible  body,  the  inertia  of  the 
structure  is  added  to  that  of  the  rigid  body  t.  Equation  (30)  becomes: 

tn  0  OT  r  f  +  ACi 

0  r  o|d>'  =  n'-d)T(0'-S%~rc;  (43) 

.«  «  oJ[ii:J  [  gWF-(X+,:K„)u- 

where  the  mass  m  and  the  inertia  tensor  X  contain  the  inertial  properties  of  the  rigid  body  f 
and  structure.  The  Erst  two  rows  of  equation  (43)  are  the  equations  of  motion  for  the  ri^d 
body.  Vectors  eg'  and  Cg  represent  the  reaction  forces  and  moments  and  are  given  by 
equations  (31)  and  (32)  The  last  row  of  equation  (43)  is  the  sutic  equilibrium  equation  for 
the  structure. 

Assuming  that  the  structure  is  linear  elastic,  i.e.,  the  constitutive  equation  is  linear  and 
the  deformations  are  small,  equation  (43)  can  be  partitioned  into: 

ft"  T^l-T  f  +  ACJ 

Ku'  =  g; 

Comparing  equation  (44b)  with  equation  (27c)  it  is  observed  that  the  nonlinear  stiffness 
matrix  vanishes  due  to  the  assumption  of  the  small  deformations.  The  linear  stiffness 

matrix  becomes  constant  due  to  the  assun^tion  of  the  linear  elastic  material  law  and  it  is 

denoted  here  by  K.  In  this  sense  u'  is  a  vector  of  total  nodal  displacements  rather  than  a 
vector  of  displacement  increments.  This  implies  that  the  vector  of  the  equivalent  nodal  forces 
^tF  vanishes.  The  vector  of  the  applied  nodal  forces  g/  still  contains  the  external  applied 
forces  over  the  nodes  and  the  forces  due  to  the  force  elements  that  are  connected  to  the 
structure.  Fot  the  purpose  of  deriving  an  expression  for  the  nodal  forces  due  to  the  impact 
with  an  obstacle,  let  it  be  assumed,  for  the  montent,  that  all  forces  applied  over  the  structure 
(vector  are  only  due  to  the  impact,  i.e.,  are  the  reaction  forces  of  the  obstacle  over 
the  structure  plus  die  contact  friction  forces. 

When  the  structure  impacts  another  object,  for  example  a  rigid  nonmoving  obstacle,  it 
undergoes  some  deformations  as  shown  in  Hgure  12(b).  In  turn,  the  effect  of  the 
deformation  of  the  structure  over  the  attached  rigid  body  is  described  by  applying  a 


(44a) 

(44b) 


force/moment  on  body  i,  as  depicted  in  figure  12(c).  This  foicc/moment,  denoted  by  f,  is 
simply  the  resultant  of  the  reaction  forces  of  the  structure  over  the  rigid  body.  Referring  to 
equauon  (44a),  the  reaction  force/moment  is  given  by 


i 


f  = 


ACi 

[-s"c'-rc; 


(45) 


> 

i 

i 

i 

\ 
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where  vectors  eg'  and  ce'  depend  upon  the  nodal  displacements  of  the  strucnire.  The 
objective  is  to  calculate  the  vector  of  nodal  dispiacements  u'  in  an  efficient  manner,  so  that 
the  reaction  forces  f  can  be  obtained. 

Let  the  node  of  the  finite  element  representation  of  the  structure  come  in  contact  with 
the  surface  of  an  obstacle.  The  surface  of  the  obstacle  is  defined  by  the  global  coordinates  of 
a  point  Qj,  denoted  by  djO,  and  a  normal  unit  vector  nj  as  shown  in  figure  13.  The  subscript 
j  is  used  tor  point  Q  and  vector  n  in  order  to  indicate  that  this  surface  contacts  node  j. 


Figure  13  Definidon  of  the  posidon  constraint  posed  by  the  rigid  surface 

At  any  given  instant,  the  global  coordinates  of  the  undefoimed  posidon  of  node  J, 
denoted  by  vector  dy,  can  be  calculated  from  the  global  configuration  of  body  i.  The 

"apparent  penetradon"  ay  of  node  j  into  the  contacting  surface,  as  illustrated  in  figure  14, 
canm  be  calculared  as 

a^  =  n[(d?-dj)  (46) 

In  reality,  the  structure  deforms  in  such  a  way  that  node  dy  remains  on  the  surface  of  the 
obstacle.  Denoting  by  5y  the  vector  of  nodal  displacements  of  node;,  the  projecdon  of  this 
vector  onto  the  normal  to  the  surface  must  be  «{ual  to  the  apparent  penetradon  ay,  i.e. 

n[5j  =  a,  (47) 
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Equation  (46)  is  substituted  into  equadon  (47)  to  yield  one  constraint  equadon  for  node  j  as: 


nT(5j  +  d,  +  d9)  =  0  (48) 

In  order  to  apply  this  constraint  to  the  stadc  equilibrium  equadons  of  the  structure, 
equadon  (44b),  the  nodal  constraint  equadon  (48)  must  be  written  in  terms  of  the  nodal 
displacements  with  respect  to  the  body  dxed  coordinate  system,  i.e., 

nT[A(8;  +  b;)+r-d?]  =  0  (49) 

This  equadon  is  leaiianged  as: 

n[A6;  =  -nT(Ab;  +  r-d9)  (50) 

This  equadon,  which  is  another  form  of  equadon  (47),  is  the  constraint  equadon  on  the 
displacement  of  node  j.  If  more  than  one  node  simultaneously  contact  one  or  more  obstacles, 
equadon  (30)  is  written  for  each  node  and  the  resulting  set  of  constraints  become 

Gu'  =  a  (51) 


where  the  rows  of  matrix  G  contain  the  components  of  vectors  normal  to  the  obstacle,  u'  is 
the  vector  of  nodal  displacements  for  ail  of  the  nodes,  and  vector  a  contains  aj's  for  all  of 
the  contacting  nodes. 
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The  reaction  force  at  node  j  is  denoted  by  It  may  be  assumed  that  there  is  also  a  friction 
force  acting  on  the  smicnire  at  that  node.  This  friction  force  g'j,as  shown  in  figure  15,  can 
be  express^  by 

g;  =  -/t|NjA"v,  (52) 

where  ^  is  the  friction  coefficient  and  Vj  is  a  unit  vector  in  the  direction  of  the  velocity  of 
node  j  projected  on  the  constraint  surface.  It  must  be  noted  that  this  force  is  valid  only  if 
there  is  sliding  of  nodey.  If  friction  force  given  by  equation  (52)  is  less  than  the  product  of 
dynamic  friction  coefficient  by  the  normal  reaction  force  due  to  the  ground  normal  reaction, 
then  stiction  occurs.  This  case  is  not  considered  here. 


iMgure  15  Reaction  and  friction  forces  at  node; 


These  constraints  are  introduced  in  the  static  equilibrium  equation  of  the  structure  using 
the  Lagrange  multiplier  technique.  Denoting  by  o  the  Lagrange  multipliers  associated  with 
the  constraints  of  the  contacting  nodes,  the  system  of  constrained  equilibrium  equations  is 


K  G^Tui  rg;- 
G  0  L«. 


(53) 


Note  that  the  term  in  equation  (53)  represems  the  constraint  forces  due  to  the  impact 
For  the yth  node,  the  quantity  Nj  is: 

G[aj=  n,<Tj  (54) 

which  is  exactly  the  reaction  force  normal  to  the  constraint  surface  at  node/.  Substituting  this 
equation  into  equation  (52)  and  observing  that  nj  is  a  unit  vector,  yields 

=  (55) 
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The  nodal  constraints  are  unilateral;  i.e.,  Cj  does  not  change  sign  and  it  is  a  positive 
quantity  as  long  as  there  is  contact.  Therefore,  equation  (55)  is  written  as 

g;  =  H[Oj  (56) 

where  =  -p.  A^Vj.  If  more  than  one  node  is  in  contact  with  the  obstacle,  and  friction 
forces  are  the  only  external  forces  on  the  structure  (excluding  the  reaction  forces),  then 
equation  (56)  is  evaluated  for  all  those  nodes.  This  yields: 

g;  =  H^a  (57) 

where  matrix  contains  all  Hj^s.  Substituting  equation  (57)  into  equation  (53)  results 


This  equation  is  solved  to  find  a  as 

o=[GK-'(G-H)^]''a  (59) 

The  dimension  of  matrix  [G  K'>  (G  •  H)]  is  it  xi;  where  i;  is  the  number  of  nodes  in  contact 
Therefore,  this  is  usually  a  veiy  small  matrix,  and  in  most  cases,  a  scalar.  This  means  that 
the  inversion  of  this  matrix  is  not  computationally  expensive.  The  stiffness  matrix  K  needs 
to  be  inverted  only  once  as  long  as  its  elements  are  not  changed.  This  is  the  case  when  only 
small  linear  elastic  deformations  are  considesed. 

After  evaluating  the  Lagrange  multipliers  o  from  equation  (59),  equations  (53)  and  (54) 
are  used  to  calculate  the  reaction  and  Action  forces  at  every  contacting  node.  Since  the 
structure  is  in  static  equilibrium,  the  set  of  reaction  force/moments  f  as  given  by  ^nations 
(45)  is  equivalent  to  the  set  of  forces  N  and  gr  as  if  they  are  directly  appii^  to  the  rigid  body 
i.  For  a  typical  contact  node y,  Nj  and  gf  act  on  body  i  at  pointy  which  is  considei^  as  an 
extension  of  body  i.  These  forces  cause  a  moment  on  body  i  due  to  the  moment  arm,  which 
is  a  vector  locating  pointy  drelative  to  the  origin  of  body  i. 

During  a  simulation,  as  long  as  none  of  the  nodes  in  the  structure  is  in  contact  with  any 
obstacles,  f  is  a  null  vector.  This  means  that  the  dynamic  analysis  proceeds  as  a  multi-rigid 
body  system.  In  order  to  detect  if  a  particular  node  y  contacts  or  penetrates  a  surface  at  a 

certain  time  step,  the  term  aj  is  calculated  from  equation  (46).  A  positive  aj  means  no 

contact  and  a  negative  •'Xj  indicates  a  penetration.  When  penetration  is  detected,  the 
corresponding  reaction  f  .e/moment  is  cdculated  and  included  in  the  vector  of  forces.  This 
reaction  forceAnoment  is  updated  as  long  as  the  node  is  in  contact  with  the  obstacle.  When 
more  than  one  node  is  detected  to  be  in  penetration,  the  sign  of  all  Lagrange  multipliers  in 
vector  a  must  be  verified.  If  any  of  these  multipliers  turns  out  to  be  negative,  its 
corresponding  constraint  must  be  removed  and  equation  (59)  must  be  solved  again.  This 
situation  can  be  described  by  referring  to  figure  16.  As  illustrated  in  figure  16(a),  Ae 
undeformed  configuration  of  two  of  the  nodes  are  in  "apparent  penetration",  i.e.,  negative 


values  for  aj's  are  obtained  from  equation  (45).  However,  in  reality,  if  the  deformation  of 
the  structure  is  considered,  only  one  node  may  be  in  contact  with  the  surface  as  shown  in 
figure  16(b}.  If  two  nodal  constraints  are  enforced,  then  an  incorrect  structural  deforreadon 
is  obtain)^  The  negadve  Lagrange  muldpUer  indicates  which  nodal  constraint  is  enforced 
incorrectly  and  consequently  must  be  removed. 


constraint 


Figure  16  An  apparent  penetration  of  two  nodes  may  yield:  (a)  a  positive 
and  a  negative  reaction  foree  for  two  incorrectly  enforced 
contacts:  (b)  removal  of  the  contact  constraint  on  one  node  yields 
correa  deformation  of  the  stnicture 


6.  Application  to  an  Utility  Truck  Rollover 

The  vehicle  simulated  here  is  an  utility  truck.  Originally  this  vehicle  did  not  have  any 
protection  in  case  of  a  rollover.  In  order  to  provide  that  extra  protection  for  passengers,  a 
toUbar  cage  was  attached  to  the  chassis  of  the  truck.  This  study  involves  determining  the 
safety  of  the  vehicle  while  the  bars  undergo  smictural  defonsations  during  the  rollover. 

The  model  of  the  vehicle,  excluding  the  loUbar  cage,  consists  of  the  main  chassis,  the 
complete  suspension  system,  and  four  wheels,  as  shown  in  figure  17.  The  front  wheels  are 
connected  to  the  main  chassis  by  unequal  A-arms  (double  wi^bones).  The  rear  wheels  are 
connected  to  the  main  chassis  by  semi*trailing  arms.  Suspension  springs,  shock  absorbers, 
and  jounce  stops  are  modeled  by  point-to*point  spring-damper  elements  with  nonlinear 
characreristics,  as  presented  in  figure  18.  Tire  characteristics  including  traction,  braking  cad 
lateral  forces  due  to  steering  were  considered  depending  on  such  factors  as  normal  force,  slip 
angle  and  camber  angle.  The  vehicle  model  consists  of  fifteen  joint  coordinates,  equal  to  the 
number  of  degrees  of  freedom  of  the  system.  Six  degrees  of  freedom  correspond  to  the 
main  chassis,  four  to  the  four  suspension  systems,  four  to  the  roiling  wheels,  and  one  to  the 
steering. 

The  roUbar  cage  is  a  flexible  frame  mounted  over  die  chassis  to  protect  the  passengers 
in  case  of  a  rollover.  The  rollbars  are  made  of  1025-1030  steel  with  a  yield  strength  of 
30, (XX)  psi.  The  cross-sectional  area  of  each  bar  is  annular  with  an  inside  radius  of  2.14  cm 
and  an  outside  radius  of  2.54  cm.  Two  models  for  the  roilbar  cage  are  considered  here:  a 
model  based  on  the  plastic  hinge  technique,  and;  a  finite  element  model. 
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Figure  17  Schematic  model  of  the  utility  truck 


Figure  18  Front  and  rear  suspension  systems  of  the  utility  truck 


6.1.  PLASTIC  HINGE  MODEL 

Within  the  framework  of  rigid  body  dynamics  it  is  possible  to  simplify  the  plastic  hinge 
model  by  assuming:  (i)  Point  panicles  with  only  thrM  transladonai  de^ees  of  freedom  to 
model  the  rollbar  cage  beam  elements  in  a  lumped  manner;  (ii)  These  particles  are  assumed  to 
be  connected  to  one  another  and  to  the  main  chassis  by  massless  Unks;  (iii)  The  relative 
angular  orientadon  of  these  massless  links  are  moniton^  dunng  the  roll  over  analysis  wd 
moments  are  applied  accordingly  using  some  constitutive  law  obtained  from  analytical 
models  or  in  suitable  experiment  tests.  This  model  is  schematically  presented  in  figure  19. 
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Figure  19  Representation  of  the  roUbar  cage  using  plastic  hinges 

A  sinqile  structure  is  considered  in  flgim  20  to  illustrate  the  present  plastic  hinge  model  as 
compared  to  the  model  described  previously.  In  the  model  (a)  moments  are  applied  in  the 

revolute  joints  according  to  some  suitable  constitutive  law  Mi »  Mi  (Oi).  In  model  (b),  the 
resistive  moments  will  be  represented  by  forces  actuating  on  the  particles. 


Bgure  20  Plastic  hinge  model  used  for  the  rollbar  cage 

For  example,  for  the  relative  angular  motion  82,  these  forces  can  be  calculated  using  the 
following  simple  vector  relationships, 

h 

A  rollover  test  for  the  truck  was  performed  by  placing  the  vehicle  over  a  cart  moving  at 
a  speed  of  30  m.p.h.  and  impacting  a  water  filled  decelerator  system,  thereby  throwing  the 
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truck  off  the  can.  The  initial  roll  angle  was  23  degrees,  and  the  height  of  release  was  30  cm 
as  shown  in  figure  21.  In  order  to  maintain  the  total  kinedc  energy  of  the  vehicle 
approximately  the  same  as  in  the  experimental  test,  an  initial  speed  for  the  truck  at  the  time  of 
departure  is  assumed  to  be  25  m.p.h.  plus  a  angular  velocity  of  1.5  rad/s  in  the  roll  direction. 
Several  accelerometers  were  attached  to  the  vehicle  to  recom  the  responses. 


Egure  21  Initial  conditions  for  the  track  before  rollover 

The  rollover  simulation  was  performed  from  the  instant  the  vehicle  departed  the  cart  A 
tiiction  model  describing  the  interaction  between  the  vehicle  and  the  concrete  ground  was 
developed.  The  vehicle  experienced  a  247<’  roll  and  came  to  a  stop  on  its  side  after 
approximately  4  seconds.  The  recorded  and  simulated  accelerations  at  the  center  of  mass  of 
the  main  chassis  were  compared  in  the  lateral  (y)  and  in  the  vertical  (z)  directions  and  are 
sumarized  in  table  2  for  p^  accelerations.  Both  the  test  and  simulation  showed  that  the 
rolbar  cage  did  not  collapse,  and  a  maximum  plastic  deformation  of  4  cm  was  observed. 


Table  2.  Comparison  of  peak  accelerations 


Experiment 

Accelentkmlg)  Hmelsec) 

Simulation 

Accelenuion  (g)  Tune  (sec) 

ymin 

ynuuc 

Zmin 

-75  0.43 

6.5  1.80 

-15.0  0.43 

«  • 

-7-7  0.44 

6.3  1.78 

-15.0  0.44 

5.2  2.24 

*  -  Not  available  due  to  accelerometer  damage 
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6.2.  FINITE  ELEMENT  MODEL 


The  finite  element  model  of  the  cage  is  composed  of  13  beam  elements  and  12  nodes. 
In  Older  to  simulate  the  attachment  of  the  cage  to  the  chassis,  6  of  the  nodes  are  fixed  to  body 
1,  as  shown  in  figure  22.  This  leads  to  a  finite  element  model  with  36  degrees  of  freuiom. 


Figure  22  RoUbar  cage  and  chassis 

In  order  to  evaluate  the  performance  of  the  methodologies  described  in  this  paper,  the 
simulations  are  made  assuming  no  fnction  between  the  contacting  roUbar  cage  nodes  and  the 
ground.  Moreover,  an  unilat^  constraint  beni'een  contact  nodes  and  ground  is  introduced 
whenever  a  node  of  the  roUbar  cage  iniciates  its  contact  with  the  ground.  This  constraint  is 
renooved  when  the  sign  of  the  Lagrange  multiplier  as.sociated  with  tliis  constraint  changes. 

Hgure  23  shows  the  vertical  displacement  of  the  center  of  the  chassis  using  complete 
coupling  between  the  gross  motion  and  the  defciination  of  the  flexible  bodies  of  the  system. 
In  die  kinetostatic  method  only  a  linear  elastic  material  behavior  is  considered.  For 
comparison  the  first  simulation  was  run  with  a  similar  material  behavior  for  the  roUbar  cage. 
A  second  simulation  was  performed  using  a  material  with  the  yield  strength  referred  to  above 
and  a  tangential  plastic  modulus  given  as  ETsE/10. 


Hgure  23  Vertical  displacement  of  the  center  of  mass  of  the  chassis 
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These  simulations  show  that  both  methods  predict  very  similar  behaviors  within  the 
first  1.5  seg.  when  a  linear  elastic  behavior  is  assumed  for  the  roilbar  cage.  The  height  of 
the  vertied  displacement  of  the  chassis  for  the  current  method  is  lower  than  for  the 
kinetostatic  method  because:  some  of  the  energy  of  the  system  is  dissipated  in  the  vibration 
of  the  cage;  there  is  inertia  coupling  between  the  vehicle  gross  motion  and  the  cage 
deformations.  This  dissipation  of  energy  is  clear  from  figure  24  where  the  lateral  deflection 
of  node  1  relative  top  the  center  of  mass  of  the  chassis  is  presented.  In  this  figure  the 
damping  of  the  vibiadon  of  the  roilbar  cage  is  shown.  Due  to  the  extreme  nonlinearity  of  the 
problem,  small  initial  deviations  between  the  results  yield  quite  different  motions  aifter  the 
initial  period.  When  an  elasto-piasdc  behavior  is  allowed  the  motion  of  tlie  vehicle  is,  as 
expect^  completely  different  fiom  that  of  the  kinetostatic  method. 


0  0^  0  4  0<  OJ  1  1,2  <4  to  U  2 

TVntW 


Hgure  24  Lateral  deflection  for  node  1  of  the  roilbar  cage 


7.  Conclusions 

General  formulations  for  the  dynamic  analysis  of  rigid  and  flexible  muldbody  systems 
suitable  for  crashworthiness  and  impact  were  reviewed  in  this  paper.  Based  on  an  updated 
Lagrangian  formuiadon,  the  geometric  and  material  nonlinear  deformation  of  a  general 
flexible  body  was  described  and  introduced  into  the  muldbody  system  descripdon.  The 
equadons  obtained  in  this  form  were  highly  nonlinear  and  inefficient  for  computadonal 
purposes.  A  simpler  form  of  these  equations  were  obtained  using  a  lumped  mass 
formulation  and  referring  the  nodal  accelerations  to  the  inertial  coordinate  fiame.  Though  a 
constant  diagonal  mass  matrix  was  obtained,  the  numerical  performance  of  th:se  equations 
was  still  not  adequate,  if  the  methodology  is  to  used  as  a  design  tool. 

Zones  of  localized  instabilities  are  difficult  to  model  in  a  simple  form  using  the  finite 
element  method.  A  plastic  hinge  and  a  finite  element  model  have  combined  to  provide 
an  hybrid  model  for  obtaining  the  dynamic  plastic  response  of  structural  systems  under 
impact  conditions.  The  numerical  metiiod  is  quite  general  and  the  impact  remonses  of  stress, 
acceleration,  velocity,  position  and  structural  generalized  displacements  of  any  part  of  the 
structure  can  be  calculated  at  any  instant  of  time,  b  has  been  shown  that  this  procedure  is 
adequate  to  predict  the  behavior  of  a  rotating  beam  impacting  a  fixed  edge.  It  was  found  that 
good  agreement  exists  between  the  theoretical/numerical  results  and  an  experimental  test 
which  was  carried  out  to  validate  the  proposed  methodolo^. 

For  .situations  where  only  a  iocalizM  part  of  the  flexible  body  deforms  as  a  result  of  an 
impact  it  may  happen  that  the  mass  of  such  region  is  neglectable  when  compared  with  the 
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mass  of  the  undefotmed  pan.  In  this  case  the  flexible  pan  of  the  body  may  be  assumed  to  be 
massless,  fhis  assumpdon  led  to  the  development  of  a  kinetostatic  model  for  crash-impact 
The  main  advantage  of  this  model  is  that  the  calculations  of  the  deformadon  of  the  flexible 
bodies  are  only  carried  on  while  contact  between  body  and  ^und  lasts.  This  methodology 
seems  promising,  but  some  work  needs  sdll  to  carried  on  in  order  to  allow  the  structural 
behavior  of  the  impacting  bodies  to  be  nonlinear. 

The  computing  dmes  for  the  flexible  models  are  at  least  one  order  of  magnimde  larger 
then  the  dmes  reqt&ed  for  the  equivalent  rigid  body  models  (plasdc  hinge  and  l^etostadc). 
This  is  due  to  the  increase  in  deg^s  of  frenlom  of  the  problem  and  the  need  to  drasdcally 
reduce  the  integradon  time  steps  in  order  to  accurately  integr^  the  high  frequency  content 
resulting  from  the  linear  elastic  structural  vibradons  of  the  flexible  bodies. 

The  mrsthodologies  described  in  this  paper,  are  quite  general  and  can  be  applied  in  the 
impact  analysis  of  complex  structures  undergoing  gross  modon  as,  for  example,  the  case  of 
vehicle  crash  situations. 
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I  ABSTRACT.  This  paper  presents  some  techniques  that  may  be  used  to  obtain  more  efficient  and  general 

f  computer-based  dynamics  modeling  and  simulation  algorithms  with  potential  real-time  applications. 

I  Constrained  equations  of  motion  are  first  formulated  in  an  augmented  differential-algebraic  form  using 

I  spatial  Cartesian  and  joint  coordinates.  Spadal  algeora  and  graph  tfaeorenc  methods  allow  separation  of 

I  system  topology,  kinemadc.  and  inertia  properties  to  obtain  generic  equation  representations.  Numerical 

I  stability  is  improved  by  employing  coordinate  partitioning  or  singular  value  decomposition  to  define 

I  suitable  sets  of  iodepeou''ot  varis^les.  Substantial  matrix  operations  during  run-time  are  avoided  by 

employing  equation  preprocessing  to  generate  explicit  expressions  for  all  dependent  variables,  and 
I  coefficients  of  their  first  and  second  time  derivatives.  The  velocity  and  acceleration  coefficients  allow 

I  explicit  elimination  of  ait  spatial  and  dependent  joint  coordinates  jdelding  a  minimal  system  of  highly 

I  coupled  differential  equanons.  A  symbolic  recunive  algorithm  that  simultaneously  decouples  the  reduced 

I  equations  of  motion  as  they  are  generated,  was  developed  to  maximize  algorithm  p^lelism. 


1.  Introduction 

Developing  real-time  computer  algorithms  for  iarge-scalo.  highly  constrained  mechanical  systems 
is  a  challenge.  Extensive  understanding  of  underlying  equation  structures,  symbolic  and 
numerical  procedures,  and  supporting  computer  architectures  is  essential.  Equation  manipulation 
ar'’  solution  procedures  may  be  hand  optimized,  but  most  are  not  easily  automated.  Problems 
stem  from  equation  complexity,  the  diversity  of  parametric  descriptions,  topology  and 
imerdisciplina^  effects,  and  changing  computer  hardwtue  and  software  architectures. 

The  purpose  of  this  paper  is  to  abstract  kinematics  and  dynamics  equations  into  block  matrix 
structures,  and  investigate  procedures  for  achieving  better  performing  computer  programs.  l.arge 
scale  constrained  systems  with  70%  or  mote  dependent  stafe  variables  ate  the  grand  challenge  for 
real-time  simulations  because  the  run-time  compuration  of  the  dependent  variables  and  terms 
depending  or.  them  represents  a  significant  overhead  in  evaluating  and  solving  the  state  equations. 
A  special  class  of  bounded  systems  composed  strictly  of  lower  pair  joints  is  considered  because 
the  kinematic  equations  allow  many  quantities  normally  computed  at  nm-time  to  be  precomputed 
and  evaluated  using  interpolating  functions.  This  can  help  reduce  recursive  computational 
bottlenecks  and  improve  parallel  processor  performance.  One  problem  with  precomputing  terms 
is  that  quantities  generated  at  successive  stages  of  recursive  decoupling  will  depend  on  increasing 
numbers  of  variables,  which  increases  dimensionality  of  the  interpolating  functions.  Function 
evaluation  overhead  increases  exponentially  with  dimensionality,  so  tradeoffs  between 
precomputing  quantities  off-line  or  evaluating  them  at  run-time  must  be  made. 
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2.  Approach 


Spatial  algebra  [1,  2]  is  used  to  formulate  the  equations  because  it  allows  rotational  and 
translational  quantities  to  be  combined  into  homogeneous  forms  malting  symbolic  manipulation 
easier.  In  addition,  a  compact  notation  simplifies  the  representation  of  arbitrary  kineicatic  and 
dynamic  quantities.  The  algebra  is  developed  in  sufficient  detail  to  provide  background  for  the 
derivations.  Spatial  vectors  and  transformations  in  configuration  and  function  spaces  are 
introduced  and  illustrated  [2,  3].  They  are  used  to  develop  compact  equations  of  motion  for  an 
unconstrained  rigid  body  and  primitive  building  blocks  for  defining  arbitrary  joints.  Block  matrix 
representations  for  constraint  systems  composed  of  any  number  of  joints  and  rigid  bodies  are 
introduced. 

A  general  graph  theoretic  approach  [4-6]  facili.<(tes  matrix  representation  of  mechanical 
systems  containing  arbitrary  parametric  and  topological  properties.  The  topology  of  a  mechanical 
system  model  with  n,  rigid  bodies  and  Oa n^  joints  is  adequately  described  by  a  connected  graph 
with  n,  nodes  corresponding  to  the  bodies,  and  n,  arcs  and  n^  chords  corresponding  to  the  joints. 
A  system’s  defining  graph  contains  a  connected  spanning  tree  with  exactly  n,  arcs  joining  the  ti, 
nodes.  The  minimal  spanning  tree  co.Tesponds  to  an  equivalent  open  kinematic-loop  mechanical 
system  with  only  the  minimum  number  of  joints  necessary  to  hold  all  the  bodies  together.  This 
includes  one  or  more  artiflcial  six  degree-of-freedom  (doO  joints  for  referencing  floating  base 
bodies  to  an  inettial  hmne.  All  variables  in  open  idnematic-loop  systems  are  independent. 

Incorporating  the  remaining  n^  chords  into  the  spanning  tree  completes  the  graph  and  generates 
Uf  independent  circuits.  Likewise,  adding  the  remaining  n^  joints  to  a  model  completes  it  and 
generates  n^  independent  kinematic  loops.  While  this  process  adds  more  joint  variables  to  the 
model,  it  subsequently  reduces  overall  system  dof  because  kinematic  loop  constraints  cause  more 

joint  variables  to  become  dependent  thw  are  added.  In  summary,  if  0  £  Iq  <  6.  i  =  1 . n,  +■  n^ 

represents  the  dof  allowed  by  the  respective  joints,  then 

dof,=  iki  (1) 

1 

represents  the  effective  system  dof  with  •■'11  chord  joints  removed.  With  chord  joints  included,  the 
system  dof  becomes  [7] 

dofjS  2k  kj  -  rankfconsttaintlacobian  matrix)  (2) 

I  C  1 

where  the  constraint  Jacobian  matrix  represents  the  composite  coefficients  of  the  combined 
system  of  linearized  kinematic  constraint  equations. 

Block  matrix  representation  of  the  uncoupled  equations  of  motion  for  the  n,  bodies  and  arc 
joints,  and  the  n^  chord  joints  given  in  a  combined  Cartesian  and  joint  coordinate  space  are  easily 
formed.  Block  Boolean  arc  and  chord  connectivity  matrices  Jiat  may  contain  embedded  spatial 
transformations,  are  used  to  couple  the  joint  and  body  equations  of  motion  through  constraint 
reaction  forces  into  a  system  of  constrained  equations  of  motion.  This  yields  a  large  system  of 
loosely  coupled  differential-algebraic  equations  involving  all  absolute  and  joint  accelerations,  and 
joint  reaction  forces  that  could  be  solved  by  sparse  matrix  and  differential-algebraic  .ntegration 
procedures  [8.  9).  However,  the  overhead  of  solving  these  equations  is  too  high  for  reai-time 
simulation  applications. 


The  kinematic  loop  consttaint  equations  and  an  iterative  Newton-Raphson  procedure  are  used 
to  solve  for  all  dependent  joint  variables  (and  subsequently  coefficients  of  their  first  and  second 
time  derivatives)  in  terms  of  selected  independent  variables  (2.  10).  This  allows  all  dependent 
joint  variables  and  their  time  derivatives  .j  be  explicitly  eliminated  yielding  a  smaller  system  of 
differential-algebraic  equations.  These  equations  may  also  be  solved  by  sparse  matrix  and 
differential-algebraic  integration  procedures,  but  again  it  would  be  impractical  for  real-time 
applications.  However,  it  is  possible  to  decouple  a  further  reduced  version  of  these  equations 
using  a  variant  of  0(n^)  LU  factorization.  Such  an  algorithm  is  developed  in  this  paper. 

Without  additional  considerations,  these  efforts  would  still  be  insufficient  to  achieve  real-time 
simulation  capability  for  most  large  scale  system  models.  Ideally,  the  equations  of  motion  would 
be  exp.'essed  in  explicit  form  as  q = f (q,  q,  t)  where  f(q,  q,  0  is  easy  to  evaluate.  The  elements  of 
f,  or  at  least  ports  of  it,  would  be  preci.  aputed  off  line  as  functions  of  q,  q  and  t  However,  this  is 
usually  impractical  because  each  element  of  f  may  depend  on  too  many  elements  of  q  and  q. 

The  problem  could  also  be  formulated  directly  in  factored  form  L(q)  U(q)  q  sg(q,  q,  t)  where 
L(q)  and  U(q)  are  nonsingular  lower  and  upper  triangular  matrices,  respectively.  Now  the 
individual  teims  in  L(q).  U(q}  and  g(q,  q,t}  will  have  fewer  variable  dependencies  and  it  may 
be  feasible  to  precompute  functional  relationships  at  the  expense  of  additional  computational 
overhead  during  mn-time.  In  most  cases,  it  is  also  impractical  to  fmd  functional  relationships  for 
all  elements  of  L(q),  U(q)  and  g(q,  q,  t)  because  they,  too,  may  depend  on  a  relatively  large 
number  of  variables.  Therefore,  some  expressions  «>2y  have  to  be  broken  down  ev.-n  further  until 
an  optimal  compromise  is  reached  between  the  overhead  of  evaluating  multivariable  functions 
versus  computing  the  quantities  at  run-time.  The  primary  advantage  of  using  precomputed 
functions  is  their  potential  for  eliminating  recursive  operations  that  bottleneck  parallel  processors. 


3.  Spatial  Algebra 

3. 1 .  NOTATIONAL  CONVENTIONS 

The  quantities  dealt  with  in  this  paper  are  first  and  second  order  tensors  that  are  generally 
represented  by  column  and  rectangular  matrices,  respectively.  Column  matrices,  usually 
identified  by  lower-case  letters,  are  used  to  represent  the  coordinates  of  first  order  tensors. 
Rectangular  and  square  matrices  represent  coordinates  of  second  order  tensors  and  are  identified 
by  upper-case  letters.  Stacked  or  block  collections  of  column  matrices  are  represented  by  bold 
lower-case  letters,  which  usually  match  the  corresponding  symbols  of  their  constituent  column 
matrices.  In  a  similar  manner,  bold  upper-case  letters  denote  block  arrays  of  matrices  that  may  be 
block  diagonal,  triangular,  symmetric  or  irregular. 

A  first  order  vector  tensor  is  denoted  by  a  lower-case  symbol  with  an  overhead  arrow  a  and  its 
three  by  one  column  coordinate  matrix  by  an  underscore 

a  =  [ai,a2,a3]^  (3) 

The  matrix  representation  of  vector  dot  product  operation  a-  is  represented  by  where 
superscript ‘T’  denotes  matrix  transpose  and  gives  a  one  by  three  row  matrix.  A  vector  cross 
product  operation  ax  is  represented  by  a  three  by  three  skew-symmetric  tensor  mauix 
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a  = 


0  “^3  ^2 
^3  0  *"^1 

“•H2  2L I  0 


(4) 


Second  order  vector  tensor  matrices  are  identified  by  underlined  symbols  that  may  be  lower  or 
upper  case. 

A  first  order  spatial  vector  tensor  is  composed  of  a  rotational  vector  tensor  and  a 
translational  vector  tensor  at  where  either  one  or  both  may  be  zero.  It  is  represented  as  a  stacked 
column  matrix  of  the  form 


a 


(i; 


Since  spatial  vectors  and  tensors  are  used  almost  exclusively  throughout  this  paper,  they  are 
denoted  by  plain  lower  and  upper  case  letters  with  no  undeiscore.  The  matrix  representation  of 
spatial  vector  inner  product  is  given  by  a^.  A  spatial  veaor  cross  product  is  represented  by  a  six 
by  sue  matrix 


[III 

that  is  not  skew*symmetric.  Spatial  vector  tensor  matrices  are  identified  by  symbols  that  are 
usually  upper-case.  Spatial  transformations  are  homogeneous,  and  can  be  represented  by  six  by 
six  [1]  or  four  by  four  [10]  matrices.  The  latter  form  is  desirable  when  carrying  out  products 
associated  with  successive  transformations  because  they  involve  fewer  multiplications.  A 
cucumflex  is  used  to  identify  the  four  by  four  matrices. 

Identity  and  zero  matrices  are  denoted  by  regular  or  bold  “I”  and  "0”  symbols,  respectively. 
Their  dimensions  are  inferred  by  adjacency  to  other  matrices.  The  0  symbols  in  sparse  matrices 
are  dropped  when  matrix  dimensions  can  be  inferred  from  other  submatrix  entries.  All  matrices 
conform  to  the  operations  implied  by  the  equations,  and  the  superscript  and  subscript  conventions 
will  be  consistent.  A  single  superscript  will  associate  the  elements  in  a  column  matrix  with  a 
given  coordinate  system  and  a  single  subscript  will  indicate  block  column  matrix  pattitioning. 
Double  superscripts  are  generally  associated  with  coordinates  of  transformation  matrices  or 
second  order  tensors.  Superscripts  and  subscripts  of  quantities  being  combined  must  conform  to 
avoid  numerical  errors.  In  addition,  adjacent  superscript  and  subscript  symbols  in  matrix  products 
must  match.  However,  transpose  and  inverse  e^ectively  interchange  matrix  rows  and  columns  so 
the  corresponding  identifying  superscript  and  subscript  symbols  on  these  matrices  will  bt! 
reversed. 

Since  general  spatial  displacement  transformations  are  not  onhogonal  or  orthonormal,  it  is 
convenient  to  identify  dual  spaces  called  configuration  and  funcuon  space,  respectively  [3]. 
Configuration  space  contains  all  dimensional  quantities  such  as  displacement,  velocity  and 
acceleration,  and  function  space  contains  derived  quantities  such  as  force  and  momentum.  A 
function  space  quantity  is  transformed  by  the  inverse  transpose  “-T”  of  any  matrix  that 
transforms  a  corresponding  configuration  space  quantity.  Reversing  the  double  superscript  or 
double  subscript  on  any  transformation  matrix  is  equivalent  to  inverting  that  matrix.  The  inverse 
and  transpose  of  orthrnormal  transformations  aie  also  equal. 
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3,2.  SPATIAL  VECTORS  AND  TRANSFORMATIONS 

Spatial  vectors  are  composed  of  bound  and  free  vector  components.  Bound  vectors  desenbe 
quantities  such  as  rotation  axes  and  forces  that  can  be  located  in  space  relative  to  reference  points. 
Free  vectors  describe  quantities  such  as  translational  directions  and  moments  that  cannot  be 
located  relative  to  reference  points. 

A  bound  vector  is  located  relative  to  a  point  by  specifying  its  moment  about  that  point.  Let  u 
denote  a  unit  vector  lying  on  a  line,  and  t  a  vector  from  some  reference  point  p  to  any  point  on 
the  line.  Then  u  and  its  moment  t  xu  about  p  completely  define  the  bound  vector.  The  moment 
t  Xu  is  a  free  vector  because  it  represents  a  quantity  that  cannot  be  associated  with  any  point.  If 
the  line  lies  on  p  then  t  xu  =0  and  it  has  no  moment  about  p. 

If  u  lies  on  some  point  q  which  has  zero  velocity  and  the  body  rotates  around  the  line  defined 
by  u  with  a  speed  of  m,  then  u  gives  its  rotational  velocity  and  tx(S  =  (o  txu  gives  the 
translational  velocity  of  any  point  p  fixed  in  the  body.  Note  that  (3  is  a  bound  vector  and  t  xq>  is  a 
free  vector.  Likewise,  if  f  denotes  the  magiutude  of  a  force  acting  at  a  point,  then  f  =  f  u  gives  its 

force  vector  andtxf  =f  txu  gives  its  toque  vector.  In  this  case,  f  is  bound  and  t  xf  is  free.  In 
configuration  space,  rotational  vector  quantities  are  bound  and  translational  vector  quantities  are 
free.  Conversely,  in  function  space,  translational  vector  quantities  are  bound  and  rotational  vector 
quantities  are  free.  In  either  case,  coordinates  of  the  rotational  component  of  a  spatial  vector  are 
always  stacked  above  coordinates  of  the  translat’onaJ  component. 

These  ideas  are  enforced  with  an  example.  Figure  la  shows  two  Cartesian  frames  labeled  a 
and  P  where  P  is  moving  relative  to  a  The  spatial  velocity  of  p  relative  to  a  in  P  coordinates  is 


=  ;PTf 


(7) 


Xa 


Xa 


(a)  Configuration  space 

Figure  1 .  Spatial  velocities  and  forces  referenced  to  frame  p. 


(b)  Function  space 


Superscript  p  is  a  reminder  that  the  coordinates  are  projected  onto  p  axes,  and  that  the  reference 
point  is  taken  at  origin  where  the  translational  velocity  is  specified.  Double  subscript  aP 
indicates  that  this  quantity  defines  the  velocity  of  P  relative  to  a. 
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Figure  lb  shows  an  equivalent  system  of  forces  acting  on  f)  that  have  been  reduced  to 


Again  superscript  P  is  a  reminder  that  the  coordinates  have  been  projected  onto  axes  and  the  net- 
force  has  been  specified  a:  0^  where  the  rotational  torque  was  aititranly  placed.  In  this  case,  the 
single  subscript  P  indicates  that  these  quantities  act  on  p. 

Figures  2a  and  2b  show  the  same  systems  where  the  spatial  velocity  and  force  arc  specified  on 
p,  but  at  the  unique  point  fixed  in  it  tha.  instantaneously  coincides  with  Oq.  Inspection  of  these 


Figure  2.  Spatial  velocities  and  forces  referenced  to  frame  ot. 


figures  reveals  that  the  relative  spatial  velocity,  which  is  now  expressed  in  a  coordinates  is 


and  the  spatial  force  is 

Now,  superscript  a  is  a  reminder  that  the  reference  point  coincides  with  and  all  vector 
quantities  have  been  transformed  to  a  Equations  7  and  9  also  imply  that  v^  may  be  interpreted 

as  representing  the  vector  sum  of  velocity  component  t  in  a  nonrotating  frame  and  the 
additional  velocity  component  at  an  arbitrary  point  *  fixed  in  a  frame  rotating  at 

around  fixed  point  Op.  Likewise  Eqs.  8  and  10  imply  that  gp  represents  the  vector  sum  of  torque 
component  7 p  with  the  additional  moment  component  t  .pxf  p  about  arbitrary  point  *  from  force 

f  p  acting  at  Op.  Before  finding  functional  relationships  between  the  quantities  in  Eqs.  7  to  10.  it 
will  be  helpful  to  develop  expressions  for  homogeneous  spatial  transformation  matrices. 
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(20) 


These  transformations  preserve  the  inner  product  between  function  and  configuration  spaces. 

Let  a°  and  represent  the  coordinates  of  arbitrary  spatial  vectors  in  configuration  space,  each 
referenced  to  ol  Then  the  matrix  representation  of  spatial  cross  product  (see  Eqs.  3  to  6) 


*•^4  ot  r  01 
ac  b,=-bc  a^ 


(21) 


holds  for  the  coordinates  of  any  two  spatial  vectors  in  configuration  space  referenced  to  the  same 
ftame.  The  cross  product  of  a  spatial  vector  with  itself  is  zero.  Let  b°  represent  the  coordinates  of 
an  arbitrary  spatial  vector  in  function  space,  referenced  to  a.  In  this  case,  the  following  matrix 
representation  of  spatial  cross  product  holds 


_aT 

-ac 


(22) 


Note  the  sign  reversal  and  matrix  transpose  when  forming  cross  products  of  spatial  vectors 
between  the  two  spaces.  Cross  products  between  spatial  vectors  in  function  space  are  not  defined. 

The  spatial  transformation  matrices  presented  in  Eqs.  14  and  17  may  be  defined  directly  in 
terms  of  spatial  vectors  as  follows.  Let 


Uo  =  [uJ.Q^r  (23) 

represent  the  spatial  coordinates  of  a  bound  unit  vector  that  defines  the  orientation  axis  between  a 
and  p,  and  let  6q^  be  the  rotational  displacement  of  P  relative  to  a  around  this  axis.  Then  (see 
Eqs.  5. 6. 1 1  and  14) 


R“^=I+sin0o;pUo  +  (l-cos0j^)Uo  (24) 

In  a  similar  manner,  let 

'J.p=[2^l5r’*  =  a,p  (25) 

represent  the  spatial  coordinates  of  a  free  translational  vector  that  defines  the  translational 
displacement  of  P  relative  to  a.  Then  (see  Eqs.  5, 6  and  17) 

T;p=I  +  t^.*=a.p  (26) 

Now  identities  similar  to  Eqs.  12  and  13  may  be  verified.  Let  a°  and  a^  denote  coordinates  of 
an  arbitrary  configuration  space  spatial  vector  in  a  and  p.  respectively.  Then  if 
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(27) 


a?  =  D“^af 

the  following  congruent  transformation  holds 


a,.  D^=D‘^a^ 


(28) 


In  a  similar  manner,  let  af  and  af  denote  coordinates  of  an  arbitrary  function  space  spatial  vector 
in  a  and  p,  respectively.  Then  if 


a?  =  D“^^af 

the  following  congruent  transformation  also  holds 


(29) 


3.3.  SPATIAL  VELOCITIES  AND  ACCELERATIONS 


(30) 


A  matrix  identity  for  rotational  velocities  may  be  obtained  by  differentiating  the  coordinates  of  an 
arbitrary  vector  fixed  in  a  moving  frame  and  equating  its  matrix  coefficients  giving  [12] 


where 


(31) 


Iij2p=R“®I|4  (32) 

defines  the  rotational  velocity  of  P  relative  to  a  (compare  with  Eqs.  13  and  12.)  Using  Eq.  15,  a 
similar  identity  may  be  derived  by  differentiating  an  arbitrary  spatial  vector  fixed  in  a  moving 
frame  and  equating  its  matrix  coefficients  giving 

•  oP  _o  oB  —oB-P 

D  =VobD^=D^Vob  (33) 

(compare  with  Eqs.  27  and  28.)  Noting  that  D**^*  =  D^  and  v^=-v^  *  =a.  p,  Eq.  33  may  be 
used  to  find  the  time  derivative  of  the  inverse  of  any  spatial  transformation  matrix  as 

d(D“^')/dt=-vSBD“^'=-D“^%  (34) 

These  identities  will  be  used  extensively  to  simplify  many  of  the  following  developments. 

It  is  convenient  to  represent  the  spatial  displacement  of  an  arbitrary  frame  or  body  by  a 
sequence  of  spatial  displacements  given  by  homogeneous  spatial  products.  For  example,  let 

(35) 
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represent  the  results  of  two  successive  spatial  displacements.  Then  Eq.  35  may  be  differentiated 
with  respected  to  time  giving 


(36) 


which,  according  to  Eq.  33.  represents  the  spatial  velocity.  Using  Eqs.  15.  27.  28  and  33.  it 
follows  that 


b“'=v^D“i^=D“^7^ 


where 


''^=''^+''py*=®-  P-Y 


(37) 


(38) 


Equanons  35  to  38  may  be  generalized  and  applied  any  number  of  times  to  write  out  spatial 
displacements  and  velocity  equations  between  any  two  frames. 

Spatial  velocities  are  differentiated  to  obtain  spatial  accelerations.  Let  a  be  fixed  and 
differentiate  v^  in  that  coordinate  system.  Differentiating  Eq.  15  gives 


a2p=d''2^dt 


iop  +  loplilBP+iap 


(39) 


which  is  the  spatial  acceleration  of  P  relative  to  fixed  a.  Observe  that  a^p  contams  an  extra  term 
that  is  quadratic  in  fint  derivatives. 

Demanding  a  homogeneous  transformation  of  spatial  accelerations  gives  the  relation 


aSpsD 


op-i 


lop+iop^, 


.)T 


(40) 


Comparing  Eq.  40  with  the  time  derivative  of  Eq.  7  shows  that  the  defined  spatial  acceleration, 
a^  does  not  represent  coordinates  of  the  true  acceleration  of  p  relative  to  a  because  it  contains  an 
additional  term  that  is  quadratic  in  first  time  derivatives.  However,  the  homogeneous 
transformation  in  Eq.  40  simplifies  the  equations  of  motion  and  the  extra  term  will  pose  no 
problems  as  long  as  it  is  subtracted  out  when  referring  to  coordinates  of  the  actual  acceleration. 


3.4.  SPATIAL  JOINT  BUILDING  BLOCKS 


In  idealized  mechanical  system  models,  rigid  bodies  are  connected  by  joints  with  nondeforming 
surfaces.  Many  types  of  joints  may  be  assembled  from  a  set  of  primitive  joint  building  blocks, 
where  each  joint  allows  only  a  single  relative  displacement  between  adjacent  frames  in  onr  of  six 
possible  directions.  The  six  direcuons  are  defined  locally  by  the  orthogonal  unit  spatial  vectors  u, 
through  Ue  as  shown  below  [5] 
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Rotation  Translation 

UiU2ti3|Q  0  Q 

[uTu^  1 

Q  Q  Q  ju,  U2  U3 

1  0  olo  0  0 
0  1  oio  0  0 
0  0  1 10  0  0 
0  0  Oil  0  0 

0  0  oio  1  0 

0  0  OiO  0  1 


(41) 


i 
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Matrices  u,  through  Uj  define  bound  rotational  directions  around  respective  common  x.  y  or  z- 

axis  pairs.  Likewise,  U4  through  u^  define  free  translauonal  directions  along  respective  common 

X.  y  or  z-axis  pairs.  If  a  primitive  joint  allows  relative  motion  around  or  along  its  axis,  then  the  > 

corresponding  spatial  unit  vector  will  define  that  joint’s  influence  coefficient  matrix  [5,  6).  ' 

Whether  a  primitive  joint  allows  a  fixed  or  a  variable  displacement,  that  displacement  is  given  by 

—  -2  * 
R,^ = I  +  sinQop  Uj  +  ( 1  -  cosSoj)  U;  (42) 

if  it  is  a  rotational  joint  (see  Eqs.  5. 6. 23. 24  and  60)  or 


if  it  is  a  translational  joint  (see  Eqs.  5. 6. 25. 26  and  61.)  The  magninide  of  rotation  is  6q^  and  the 
magnitude  of  translation  is  to^.  Any  number  of  constant  and  variable  primitive  joint  building 
blocks  may  be  combined  sequentially  to  form  numerous  joint  configurations  by  multiplying  the 
respective  displacement  transformation  matrices  together  as  illustrated  in  Eq.  35.  This  approach 
allows  constant  displacement  transformations  to  appear  in  variable  displacement  transformations. 

Let  joint  i  have  0  £  kj  <  6  dof  and  associated  with  it.  if  kj  >  0,  is  a  6  by  kj  influence  coefficient 
matrix  H“,  where  the  individual  columns  coircspond  to  the  primitive  joint  influence  coefficient 
matrices,  each  transformed  to  the  common  fiame  a.  Also  there  is  a  .kj  by  1  column  matrix  of 
primitive  joint  rotational  and  translational  variables  pj  that  correspond  to  the  Iq  joint  dof.  It  is 
assumed  tiiat  each  joint  is  defined  so  will  have  firll  column  rank.  If  this  composite  joint 
connects  frames  a  and  P.  there  is  a  spatial  displacement  matrix  formed  from  a  sequence  of 
primitive  spatial  displacement  products  that  depend  on  the  p,  variables,  as  well  as  zero  or  more 
constant  primitive  displacements.  The  spatial  velocity  of  P  relative  to  a  in  a  coordinates  is 

v^=HrPi  (44) 

Each  primitive  joint  and  corresponding  spatial  displacement  or  velocity  will  have  an  associated 
direction  or  orientation.  The  displacement  transformation  of  any  primitive  joint  oriented  opposite 
to  the  assumed  composite  joint  orientation  must  be  inverted  when  forming  the  product  dJ^.  The. 
inverse  may  also  be  affected  by  reversing  the  sign  on  the  corresponding  variable  in  Pj.  In  Eq.  44, 
this  inversion  may  be  acf  ounted  for  by  reversing  the  sign  on  the  corresponding  column  of  h“. 

The  time  derivative  of  H“  is  required  when  computing  the  relative  spatial  acceleration.  To  find 
this  derivative,  first  note  that  the  jth  column  of  denoted  by  defines  one  displacement 

transformation  appearing  in  the  product  forming  D,“^  (see  Eqs.  41  to  43.)  Let 

H“-Dr'u.j  =  D“*u.j.l<j^k,  (45) 
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represent  the  jth  primitive  joint  connecting  frames  y  and  5  that  allows  one  dof,  where  u.j  is  one  of 
the  six  constant  spatial  unit  vectors  in  Eq.  41.  Either  transformation  is  valid  because  the  influence 

vS 

coefficient  matrix  u.j  is  invariant  under  transformation  Dj  .  Now 


Df^=Dj^Df=DfDf 
and  if  a  is  fixed 


(46) 


(47) 


Derivatives  of  successive  columns  of  H“  include  additional  terms  from  the  relative  velocity 
vector  vjp.  From  Eq.  44,  note  that  v^  is  the  sum  of  the  Iq  relative  spatial  velocities  across  the  k, 
pnmitive  joints  and  v^  is  the  sum  of  the  first  j  of  these.  For  programming  purposes,  explicit 
expressions  for  time  derivatives  of  the  influence  coefficient  matrices  may  be  written  out  directly 

>  <X 

and  it  suffices  to  leave  them  in  the  form  Hy.  With  this  convention,  differentiating  Eq.  44  gives 


aSp=Hi“Pi  +  H“pi 


(48) 


If  a  is  not  fixed,  then  there  will  be  some  frame  such  as  0  that  is,  and  the  above  influence 
coefficient  matrices  may  be  transformed  to  that  frame.  In  this  case.  Eq.  44  is  transformed  before 
differentiating,  and  as  indicated  in  Eqs.  35  to  38,  the  additional  spatial  velocity  cross  product 
associated  with  differentiating  this  transformation  will  be  included  in  the  influence  coefficient 
matrix  derivative. 


3.5.  SPATIAL  EQUATIONS  OF  MOTION  FOR  SINGLE  BODY 

The  spatial  equations  of  motion  for  an  unconstrained  rigid  body  may  be  obtained  by 
oiittrsntiating  the  coordinates  of  its  spatial  momentum  that  have  been  expressed  in  a  fixed  or 
inertial  frame.  Figure  3  shows  a  rigid  body  with  embedded  frames  a  and  c  where  frame  c  defines 
tlie  principal  centroidal  axes. 


Figure  3.  Rigid  body  with  arbitrary  frame  a  and  principal  centroidal  axes  c  shown  relative  to 
inertial  frame  0. 


4.  Constrained  Equations  of  Motion 

4. 1 .  REPRESENTATION  OF  SYSTEM  TOPOLOGY 

It  is  assumed  that  motion  is  measured  rciativc  to  an  menial  frame,  denoted  by  the  symbol  0.  Thus 
the  absolute  displacement,  velocity,  etc.,  of  every  body  in  the  system  will  be  measured  relative  to 
0.  However,  if  the  absolute  displacement,  velocity,  etc.  of  one  body  in  a  collection  of  bodies 
connected  by  joints  is  known,  and  if  the  corresponding  relative  joint  displacement  quantitie*:  are 
also  known,  then  all  absolute  quantities  may  be  calculated  from  this  information  Graph  theoretic 
methods  are  used  to  provide  an  organized  means  to  accomplish  these  calculations. 

It  is  also  assumed  that  constrained  mechanical  systems  are  composed  of  rigid  bodies  connected 
by  idealized  joints  with  nondeforming  surfaces.  Furthermore,  one  body  in  each  kiiiematicaliv 
disconnected  system  (designated  as  the  base  body)  must  be  physically  connected  to  0  or 
referenced  to  it  by  an  aitificiai  six  dof  joint  that  gives  its  absolute  displacement  relative  to  0.  The 
remaining  bodies  in  each  dis  onnected  system  are  directly  or  indirectly  connected  to  the 
corresponding  base  body  by  additional  joints.  The  minimum  number  of  joints  (including  the 
artificial  six  dof  ones)  necessary  to  tie  all  bodies  together  into  a  contiguous  system  (no  closed 
kinematic  loops)  is  exactly  equal  to  the  number  of  bodies  in  the  system.  It  is  convenient  to 
describe  the  interconnectivity  of  these  n,  bodies  through  the  corresponding  Oj  joints  with  a 
minimum  spanning  tree.  The  joints  comprising  this  tree  are  called  arcs  and  their  number,  and  the 
corresponding  number  of  bodies  are  denoted  by  n,.  The  subscript  a  is  used  extensively  to  denote 
various  quantities  associated  with  the  spanning  tree.  Figure  4  shows  an  example  spanning  tree 
where  rectangles,  solid  lines  and  dashed  lines  identify  respective  nodes  (bodies),  and  ares  and 
chords  (ioints). 

An  n,  by  n.  Boolean  arc  conneedvity  matrix  C,  may  be  devised  to  associate  each  arc  joint  with 
the  corresponding  two  bodies  (parent  and  child)  joined  by  it.  The  base  body  is  at  the  base  of  the 
spanning  tree  and  the  other  arc  joints  and  bodies  radiate  outward  from  there.  Assume  that  each 
joint  has  been  oriented  so  its  corresponding  child  body  (fanher  out  in  the  tree)  is  referenced 
positively  to  its  parent  body  across  the  joint  Now  it  is  possible  to  associate  each  of  the  n,  joints 
with  exactly  one  and  only  one  unique  child  body.  Furthermore,  let  the  n,  joints  and  bodies  be 
ordered  so  that  no  child  appears  before  its  parent  in  the  list.  Associate  the  columns  of  with  the 
bodies,  and  the  rows  with  the  joints.  Within  each  row.  place  a  “1”  in  the  column  corresponding  to 
the  child  body  and  “-1”  in  the  column  corresponding  to  the  parent  body.  Frame  0  does  not  appear 
in  this  matrix,  so  there  will  be  no  parent  entry  for  any  base  body. 


Figure  4.  Example  spanning  tree  showing  nodes,  arcs  and  chords.  The  arc  Cj  and  chord  Cj 
connectivity  matrices,  and  their  respective  inverses  R,  and  are  also  shown. 


With  this  convention.  is  now  lower  triangular  with  I  s  on  the  diagonal  and  hcs  a  lower 
tiianguiar  inverse  denoted  by  R,.  In  this  form  Rj  may  be  wnp.en  down  just  as  easily  as  Cj  from 
the  spanning  tree  representation  of  the  system.  Slatting  from  the  jth  body  in  the  system,  place  a 
"1”  in  each  row  i.  column  j  position  corresponding  to  each  body  i  that  is  a  deicendant  of  body  j. 
Alternately  the  non2ero  entries  in  the  iih  row  of  Rj  identify  the  arc  joints  (and  their  orientao.ons) 
which  lie  in  the  shortest  path  from  the  root  of  the  tree  to  tht  ith  joint. 

The  remaining  joints  in  the  system  (indicated  by  dashed  lines)  connect  bodies  to  form  closed 
kinematic  loops.  These  joints  are  called  chords  and  their  number  is  denoted  by  t.he  symbol  n^. 
They  generate  exactly  n^  Independent  closed  kinematic  loop.<;.  Similar  to  the  above  discussion,  an 
n,  by  n.  Boolean  chord  connectivity  matrix  may  be  dcvited  to  associate  each  chord  joint  widi 
the  corresponding  Vf/o  bodies  it  joins.  Assigning  an  orientation  to  each  joint  with  associated 
parent  and  child  bodies,  each  row  of  will  contain  exactly  one  “1”  and  one  “-1".  Cleailv  C.  is 
rectangular  and  does  not  have  an  inverse.  However,  it  docs  have  a  tight  inverse  defined  by 

R,=-C,R3  (58) 

Similar  to  R,  above,  the  nonzero  entries  in  tht  kth  row  of  R^  identify  the  arc  joints  and  their 
orientations  relative  to  the  ktli  kinenimic  loop  and  corresponding  kth  chord  joint.  This  conventio 
assures  that  each  chord  joint  and  corresponding  kinematic  loop  have  the  same  orientation. 

4.2.  ABSOLUTE  SPATIAL  DISPLACEMENTS  IN  CONSTRAINED  SYSTEMS 


The  kth  chord  joint  represented  by  spatial  displacement  matrix  DjJ  cotmeas  two  tree  branches  to 
fem  a  closed  kinematic  loop  These  branches  share  a  comr  ion  ancestor  body,  say  a.  Matrices  Df 
and  are  deHned  by  identifying  those  joints  in  each  branch  corresponding  to  the  nonzero 
entries  in  the  portions  of  rows  i  and  j  of  R,  located  from  its  diagoiud  left  to,  but  not  including. 
colum.i  ot.  The  constraint  loop  will  be  oricitteu  with  D“  and  DjJ,  and  opposite  to  D“^  The  net 
displacement  around  any  closed  loop  must  be  zero,  which  is  described  by  the  matrix  product 

(59) 

Equation  59  diifines  the  loop  constraint  equations,  but  it  is  evaluated  using  iransformation 
matrices  of  the  fonn 


and 


R  = 


1  12^' 
Q 


A«  /.“P 

D  =T,^R  =R  T^ 
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(60) 

(61) 


Now  Eq.  59  may  be  revised  lo  read 


A®  A®*AyA®J"*  0  y 

\=DkDkD,  -1=  a  (63) 

.aikistk, 

where  and  correspond  to  respective  rotational  and  translational  constraint  violations. 
Numerical  values  for  all  loop  constraint  equations  are  obtained  tom  expressions  such  as  Eq.  63. 

The  constraint  equations  are  nonlinear,  and  to  solve  for  the  dependent  joint  variables  requires  a 
procedure  such  as  Newton-Raphson  iteration  and  a  Jacobian  matrix.  The  constraint  loop  Jacobian 
matrix  may  be  expressed  directly  in  terms  of  joint  influence  coefficient  matrices.  First  let 

(64) 

represent  a  stacked  column  matrix  of  small  changes  in  relative  displacements  between  adjacent 
bodies  connected  by  arc  joints  where  the  elements  are  stacked  in  the  same  order  as  the  bodies  and 
joints.  Column  matrix  Ap,  contains  small  changes  in  ate  joint  displacements  stacked  in  the  same 
order.  Matrix  is  a  stacked  block  diagonal  matrix  of  the  individual  arc  joint  influence 
coefficient  matrices,  all  transformed  to  0. 

Arranging  all  chord  joints  in  a  similar  manner  gives  a  second  displacement  equation 

Ad2=H®Ap,  (65) 


where  now  Ad^  is  a  stacked  column  matrix  of  small  changes  in  relative  displacements  between 
bodies  connected  by  chord  joints,  Ap^  contains  small  changes  in  all  chord  joint  displacements  and 
matrix  H;  is  a  stacked  block  diagonal  matrix  of  the  chord  joint  influence  coefficients. 

Earlier  it  was  noted  that  the  kth  row  of  R^,  as  defined  in  Eq.  58,  specifies  which  arc  joints 
appear  in  the  kinematic  loop  defined  by  that  row,  and  it  also  defines  how  they  are  oriented 
relative  to  the  loop.  Let  (and  likewise  the  other  topological  matrices)  be  composed  of  six  by 
six  identity  matrices  replacing  the  I’s  and  six  by  six  zero  matrices  replacing  the  O’s.  The  product 
R^Ad,  adds  up  all  small  arc  joint  displacements  in  all  constraint  loops.  Combining  these 
displacements  with  the  remaining  small  chord  joint  displacements  detoed  in  Eq.  65  gives  the 
total  constrained  system  tUsplacement  as 

A(ti®=R“Ad°+Ad®  (66) 

where  A(|i°  represents  a  stacked  column  matrix  of  the  first  order  variations  in  the  constraints. 
Substituting  Eqs.  64  and  65  into  Eq.  66  and  factoring  out  the  coefficients  of  Ap,  and  Ap^ 
identifies  the  loop  constraint  Jacobian  nuurix 


[ReH°,H°]|^P*j=A0° 


For  Newton-Raphson  iteration,  these  equations  are  revised  as 


Jt  r> 


where  k  is  an  iteration  counter.  Similar  equations  may  be  defined  using  Eq.  72  instead. 

Equations  74  and  75  provide  an  opponunity  to  numerically  precompute  all  dependent  joint 
variables  in  terms  of  the  selected  independent  ones.  This  is  done  by  sweeping  the  individual 
independent  variables  through  their  limited  domains  and  generating  multidimensional  surfaces  of 
the  dependent  quantities.  The  surfaces  may  be  interpolated  by  polynomials  or  other  suitable 
functions  and  stored' in  memory 'for  future  tun-time  evaluation.  If  such  functions  have  been 
defined,  then  p^Cq)  and  Pc(q)  are  given  explicitly  in  terms  of  q  and  the  system  configuration  may 
be  evaluated  during  mn  time  without  iteration. 

4.3.  SPATIAL  VELOCmES  IN  CONSTRAINED  SYSTEMS 


The  relative  spatial  velocities  between  the  bodies  connected  by  respective  arc  and  chord  joints 
may  be  wrinen  in  inertial  frame  coordinates  as  (compare  with  Eqs.  64  and  65) 

v°=H°p,  (76) 


Vc°»H°p,  (77) 

The  absolute  spatial  velocities  of  all  bodies  relative  to  the  inertial  frame  are  collected  into  a 
stacked  block  column  matrix  v°.  Absolute  velocities  and  the  relative  velocities  in  Eqs.  76  and  77 
ate  related  by  arc  and  chord  connectivity  matrices  as 


CcV°»H°p, 


Substituting  Eq.  78  into  Eq.  79  and  using  the  identity  in  Eq.  58  gives  (compare  with  Eq.  67) 


[r,h°.h°][M=0 

[PcJ 


which  is  the  time  derivative  of  the  loop  constraint  equations.  Combining  Eq.  80  with  the  time 
derivative  of  Eqs.  69  and  73  gives  (compare  with  Eq.  74) 


RcH°  H° 
Va  Vc 


•  ® 

P*  =  0 

Pc.  A 


Equation  81  shows  that  if  all  independent  velocities  are  specified,  the  complete  system  velocity 
can  be  computed. 


|.:|v 

I 

! ''.'-4'  'i'-'  '■ 
V  " 

I. 


Since  p,(q)  and  p^(q)  are  explicit  functions  of  q.  let 

P>=9Pa(‘lV3‘iq=B2(‘l)q 


Pj=ap<.{q)/aqq=Bj(q)q 

Substituting  Eqs.  82  and  83  into  Eq.  81  and  equating  coefficients  of  the  independent  q  gives 

fRcH°  H“  ,  fol 


c — a  — c  r*«,  1  V 

®a  A 

Va  Vc  B  =  ® 
V  V  L  I 


which  may  be  used  to  numerically  evaluate  B,  and  B^  as  explicit  functions  of  q. 

4.4.  SPATIAL  ACCELERATIONS  IN  CONSTRAINED  SYSTEMS 

Explicit  expressions  for  spatial  accelerations  are  also  required  to  formulate  the  equations  of 
motion.  Differentiating  Eq.  78  gives 

a®*R,H°p,+R,H°p,  (85) 

which  shows  that  p,  is  also  required  when  evaluating  a*’.  Differentiating  Eqs.  82  and  83  gives 

Pa  =  Ba  q  +  3B/aqi  q,]  q  (86) 

and 

Pc  =  Be  q  +  9B/aqi  qj]  q  (87) 

Equations  86  and  87  indicate  that  second  partial  derivatives  of  p^Cq)  and  p^Cq)  are  required  when 
accelerations  must  be  computed.  These  quantities  may  be  evaluated  by  taking  the  partial 
derivative  of  Eq.  84  with  respect  to  each  of  the  independent  variables  giving 

RjHJ  H°  ]  r-R£3H®/aqiB,-9H^9q,B,' 

Va  Vc  =  -Rca¥a%Ba-aVc/aq|Bc  .-i=1.2 . dof  (88) 

0  ’  ^ 

Explicit  symbolic  expressions  for  the  partial  derivatives  of  H,  (also  required  to  evaluate  in 
Eq.  85)  and  may  be  obtained  with  the  help  of  Eqs.  33  to  38  (see  the  discussion  in  Section  3.4 
as  well.)  The  basic  identities  dH^/dqj  sdH^/dqj  and  dH^/dq;  sdH^dcjj  are  helpful  in  this  process. 


V' 


I-.?.""  ' 


4.5.  AUGMENTED  AND  REDUCED  EQUATIONS  OF  MOTION 


The  equations  of  motion  for  unconstrained  rigid  bodies  were  given  in  Eq.  57.  Now  let 

M“a°  =  7“^P°  +  gO  +  cJf^+C^^  (89) 

represent  the  composite  system  of  constrained  equations  of  motion.  Matrix  M*’*’  is  a  symmetric, 
stacked  block  diagonal  composition  of  the  individual  body  inertia  submatrices  M^  arranged  in 
the  same  order  as  the  arc  joints.  Likewise,  column  matrix  contains  the  array  of  spatial  forces, 
n  -0 

gQ.  Matrix  v  is  a  stacked  block  diagonal  composition  of  the  individual  six  by  six  spatial  velocity 
cross  product  submatrices  of  the  form  given  in  Eq.  6.  Each  joint  in  the  system  has  a  corresponding 
internal  spatial  reaction  force.  The  stacked  matrix  of  arc  joint  reaction  forces  is  denoted  as  ^  and 
the  matrix  of  chord  reaction  forces  is  represented  by  The  connectivity  matrices  cj[  and 
place  the  appropriate  joint  reaction  forces  into  the  correct  equations  of  motion  in  Eq.  89. 

The  joint  reaction  forces  in  and  contain  components  of  forces  that  are  tangent  to  the  joint 
manifolds  and  other  components  that  are  perpendicular  to  them.  If  every  joint  is  workless,  then 
the  projection  of  these  reaction  forces  onto  the  tangent  directions  will  all  be  zero.  If  joints  contain 
active  internal  forces  such  as  actuators  or  friction,  then  the  projections  will  be  equal  to  these 
quantities.  These  nonzero  internal  forces  act  in  the  same  directions  as  the  corresponding  joint 
displacements  and  p^.,  and  are  given  as 

Q.=Hff;  (90) 

and 

Qc=H^f?  (91) 

These  reaction  forces  may  also  be  projected  onto  the  independent  variable  subspace  using  the 
velocity  coefficient  matrices  Bj  and  defined  earlier  as 

Q„  =  BlQ,=H”fS  (92) 

and 


where 


and 


H2q  =  H°B, 

Hcq  =  H°B, 


Equations  85.  89,  92  and  93  represent  the  augmented  constrained  equations  of  motion.  To 
obtain  the  reduced  equations  of  motion,  first  substitute  Eq.  85  into  Eq.  89.  then  isolate  by 
invetting  cj  and  substitute  this  result  into  Eq.  92  giving 


•  J  q  -Q,.  +  (r,  (-C^  +  g® + -  M®°  R,  q) 


j=(r,0^m“(r,h2,) 


The  unknown  chord  joint  reaction  forces  may  be  eliminated  from  Eq.  96  using  Eqs.  58  and  93 
to  show  that 


-(R,O^Crf?=Q,, 


Thus  Eq.  96  reduces  to  the  final  foim 


Jq=Qa 


where  J  is  given  in  Eq.  97  and 


Qq  =  Qq.  +  Qqc  +  («,  R,  q) 


5.0.  Recursive  Reduction  and  Uncoupling  of  Equations  of  Motion 


The  methods  and  techniques  used  to  implement  algorithms  on  the  computer  for  evaluating  and 
uncoupling  the  equations  of  motion  for  highly  constrained  mechanical  systems  are  ctucial  to 
achieving  real-time  simulation  capability.  Factorization  algorithms  that  follow  minimum  path 
uajectories  through  a  system's  topology  will  have  the  smallest  computational  overhead.  These 
algorithms  invoke  recursive  application  of  matrix  projections. 

No  matter  how  broad  a  system's  spanning  tree,  if  the  nodes  are  grouped  by  level,  connectivity 
matrix  Cj  may  be  block  partitioned  as  if  representing  a  single  chain.  In  addition  to  simplifying 
algorithm  development,  this  arrangement  also  maximizes  parallelism  across  the  projection  front, 
ensuring  the  best  processor  performance.  A  four  level  example  is  used  to  illustrate  the  algorithm. 


FOUR  LEVEL EXAMPLE 


The  minimum  spanning  tree  graph  for  a  constrained  mechanical  system  may  be  arranged  many 
different  ways,  and  it  is  convenient  to  order  the  arc  joints  so  they  are  grouped  by  levels  according 
to  the  arrangement  of  independent  variables  within  each  level.  When  all  arc  joints  within  each 
level  are  also  adjacent  in  the  arc  connectivity  matrix,  it  will  partition  into  contiguous  block 
submatrices  making  it  easier  to  derive  and  illusuate  the  recursive  uncoupling  algorithm. 


I 


.  y  ^  .y 


By. 
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Consider  a  cons'rained  mechanical  system  contmning  a  number  of  closed  kinematic  loops  that 
has  been  partitioned  into  four  discrete  levels  from  the  base  to  the  outer  leaves  of  the  tree.  The 
actual  spanning  tree  may  have  more  than  four  levels  so  some  levels  within  this  partitioning  may 
contain  arc  joints  and  bodies  from  several  levels  of  the  spanmng  tree.  The  four  level  partitioning 
of  the  arc  connectivity  matrix  is  written  as 

■  c.„ 

~Cj.2i  Cj,22 

r  (101) 

'-*32  *-133 

“C»43  ^744 . 

where  each  matrix  on  the  diagonal  is  also  diagonal  or  lower  triangular  and  nonsingular. 
Numerical  subscripts  on  the  submatrices  indicate  their  relative  positions  within  the  composite 
connectivity  matrix.  Negative  signs  were  factored  out  of  the  off-diagonal  submatrices  because 
evei7  nonzero  off-diagonal  submatrix  has  a  negative  sign  in  front  of  it  (see  the  matrix  in  Fig.  4.) 

The  various  stacked  matrices  developed  eariier  may  also  be  block  partitioned  according  to  the 
partitioning  in  Eq.  101.  With  suitable  arrangement  of  the  arc  joints  within  the  spanning  tree  and 
partitioning  of  the  independent  variables,  matrix  can  always  be  arranged  in  lower  block 
triangular  form  and  most  of  the  partitioned  block  submaiiices  below  the  diagonal  will  be  zero. 

Equation  101  is  modified  to  simplify  the  recursive  algorithm  development  by  premutiplying  by 
the  inverse  of  its  diagonal  matrices 


R,=c;‘= 


to  give  a  modified  connectivity  matrix 


C  =  R,C,= 


I 

-Cz.  I 

-C32  1 


-C43  I 


5.2.  RECURSIVE  REDUCTION  AND  UNCOUPLING  ALGORITHM 
For  the  four  level  example,  Eq.  99  is  written  in  block  partiticaed  foim  as 


J11J12J13J14  Si  Q| 

•^21  '^22  ^23  ^24  Nz  L  Qz 

JziJzzJzzJz^  S3  Q3 

J41  J42  J43  J44  S»  Q4 
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A  modified  version  of  block  matrix  factorization  will  be  used  to  isolate  the  variables  in  Eq.  104. 
The  primary  advantage  of  this  algorithm  is  that  the  partitioned  coefficient  matrix  does  not  have  to 
be  fully  evaluated  before  the  decoupling  procedure  can  begin.  The  matrix  representation  of  J  in 
Eq.  97  is  first  revised  by  solving  Eq.  103  for 

R,  =  C'‘Rj  =  RR,  (105) 

and  substituting  to  give 

JsH’^r'^MRH  (106) 


where 


m=m“= 


M. 


M,. 


M 


33 


M, 


'44 


and 


(107) 


H  =  R,Hi,= 


H,, 

Hi,  Hu 
Hj,  Hji  H33 
H4,  H42  H43  H44 


(108) 


As  noted  earlier,  matrix  H  is  shown  worst  case  and  many  of  the  block  matrices  below  the 
diagonal  may  be  zero.  Now  C.  as  defined  in  Eq.  103.  may  be  factored  into  the  product  of 
elementary  matrices  that  are  easily  inverted  to  give 


I 


R=: 


1 


I 

C43  I 


I 


I 

C31  I 


1 


If  * 

C,,  I 

I 

Jl 

I J 

(109) 


The  factored  form  of  R  in  Eq.  109  makes  the  recursive  decoupling  algorithm  easier  to  derive 
and  understand.  The  algorithm  represents  the  operations  necessary  to  evaluate  J  in  Eq.  106. 
perform  LU  factorization  and  solve  for  the  unknowns.  Most  significantly,  the  LU  factors  of  J  are 
generated  as  it  is  evaluated.  As  implied  by  Eq.  109.  an  n-level  system-  requires  n-1  projection 
operations  to  evaluate  J  and  an  additional  n-1  projection  operations  to  generate  its  LU  factors. 
Ttus  algorithm  works  in  a  pipeline  fashion.  After  completing  the  first  level  evaluation  of  J.  it  then 
simultaneously  works  on  the  second  level  evaluation  and  the  first  level  LU  factorization.  This 
process  continues  until  the  final  factorization  has  been  accomplished  at  the  nth  step.  Rather  than 
2n-2  steps,  this  algorithm  requires  n  steps  which  is  significant  when  parallel  processors  ar^  used. 


y  Ain' 
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To  keep  the  algorithm  compact,  the  contents  of  various  matrices  are  overwrinen.  The  overwriting 
operation  is  indicated  by  the  assignment  arrow 
Assuming  an  n  level  system,  the  algorithm  follows; 


(1) 

First  perform  the  initialization 

{(i  =  n.  n-1 . l).J  =  i.  i-1 . 1) 

(2) 

fln~*lnn  Qn 

Next,  setting  k  =  n-1.  the  evaluation  procedure  continues  recursively  as  follows: 

(3) 

(j  =  n.  n-1 . k+1) 

(4) 

Mkk  ^ 

(5) 

Jij  ^  Jij  ®lki  ^kk  ®  kj 

((i  =  k.  k-1 . l).j  =  i,  i-1 . 1) 

(6) 

jij=« 

(i.j  =k.k-l . 1) 

(7) 

Jij  jy + H  H|(j 

{(m  =  n.  n-1 . k+1).  i.j  =  k.  k-1....,  1) 

(8) 

Jij<~  Jij+ Jij  + Jji 

((i  =  k,  k-1, ....  1),  j  =  i.  i-1 . 1) 

(9) 

Jij<-J,j  +  HjiM^Hkj  (((m  =  n.n 

-1 . k+1).  i  =  m.  m-1, ....  k+1).  j  =  k.  k-1 . 1) 

(10) 

Jik^  Jjk”  Jji  I'jk(l®  j“l*  j~2.  ....k) 

1 

/  G  =  n.n-1 . k+1) 

(11) 

Qk<-Qk-L^Qj  J 

4k=JkkQk 

1 

(12) 

reduce  k  <-  k  -  1 

(13) 

if  k  =  0.  decoupling  procedure  is  completed:  recourse  to  step  (15)  below. 

(14) 

recourse  to  step  (3).  above  until  completed. 

(15) 

increase  k  k  +  1 

(16) 

if  k  =  n.  algorithm  is  completed;  stop. 

a  =  k.k-l . 1) 

(17) 

recourse  to  step  (15).  above  until  completed. 

This  algorithm  gives  a  rough  picture  of  the  procedures  required  to  uncouple  the  equations  of 
motion  using  block  submauices.  The  algorithtn  represents  worst  case  because  many  of  the 
submatrices  of  H  appearing  in  steps  1,  5.  7  and  9  may  be  zero.  Algorithm  changes  may  be 
accounted  for  by  modifying  the  index  counters  to  skip  over  zero  matrices.  For  effective  parallel 
implementation,  the  algorithm  should  not  be  considered  as  strictly  sequential.  For  large  scale 
problems,  most  of  the  submauices  will  be  sparse  and  substantial  overhead  will  be  saved  by 
breaking  these  operations  down  even  further. 

In  the  current  formulation,  connectivity  matrices  C,c4.|.ic  contain  only  I’s  and  O’s.  so  steps  3  and 
4  require  simple  additions.  These  connectivity  matrices  effectively  transform  child  body  inertia 
matrices  to  conform  with  parent  body  inertias  so  they  can  be  projected  or  added  onto  the 
appropriate  patent  inertias.  In  the  present  form,  the  inertia  and  influence  coefficient  matrices  are 
all  expressed  in  a  common  frame.  The  inertia  and  influence  coefficient  matrices  may  also  be 
expressed  in  local  body  frames  so  the  terms  will  involve  fewer  variables.  Now  the  connectivity 
'.latrices  Cif^i.k  will  contain  local  spatial  transformation  matrices  to  transform  inertia  matrices, 
similar  to  ^s.  52  and  54.  However,  this  will  make  it  much  easier  to  analyze  the  equations  and 
determine  variable  dependencies  for  precomputing  coefficients.  In  many  applications,  this  form 
will  result  in  a  higher  percentage  of  the  operations  involving  three  or  less  variables,  making 


interpolation  of  these  quantities  practical.  This  discussion  clearly  indicates  the  evolution  of  hybrid 
techniques  and  shows  that  automated  optimization  of  general  system  models  will  be  difficult. 

Obviously  the  operations  necessary  to  evaluate  in  Eq.  100  must  also  be  taken  into  account. 
These  equations  contain  many  of  the  same  quantities  appearing  in  J.  and  it  will  be  possible  to  use 
interpolating  functions  here  as  well.  Another  factor  important  to  load  balancing  on  parallel 
processors,  is  synchronizing  the  evaluation  of  these  equations  with  those  in  the  above  algbiithm. 


6.  L«r^  Scale  V^de  Example 


A  large  scale  vehicle  modej^is  presented  to  illustrate  the  types  of  simulations  possible  using  the 
procedures  bi<cfiy  describe  in  this  paper.  Figures  5  to  7  show  computer  generated  graphical 
images  of  the  vehicle  system  with  cutaway  views  illustrating  major  steering  and  suspension 
components.  The  system  is  composed  of  an  eight  by  eight  tractor  towing  a  multiaxle  trailer 
carding  a  tracked  vehicle.  The  wheels  on  tractor  axles  one  and  two  are  steered  and  all  steering 
and  suspension  kinematic  linkages  were  accurately  modeled.  Nonlinear  suspension  compliance, 
damping,  hysteresis,  and  jounce  and  rebound  limiters  on  all  three  vehicles  were  accurately 
modeled  with  nonlinear  functions  using  measured  data.  Wheels  on  all  three  vehicles  are  allowed 
to  rotate  and  leave  the  surface,,  and  support  and  tractive  tire  forces  are  modeled  in  ail  three 
directions  on  every  wheel,  llie  tramr  drive  train  was  not  modeled,  but  the  vehicle  is  propelled  by 
applying  eq^  driving  torques  to  all  eigitt  wheels. 

The  tracked  vehicle  model,  with  40  dof  is  a  fully  fonctional  stand>alone  system  composed  of 
35  rigid  bodi^  (chaissis,  14  road  arm/rbad  wheel  pairs.  .2  drive  sprockets,  2  idlers,  turret  and 
trunnion,)  35  joints  and  no  clos^  kinematic  loops.  The  model  has  massless  deformable  tracks 
that  support  the  toad  wheels  iuid  allow  it  .tp  be  propelled  and  steered  through  the  drive  sprockets. 
It  is  interfaced  with  the  trailer  chissi^  mbdel  through  deformable  road  wheel  models  that  can 
rotate  and  slide.  d^elop.foioM  in  all  three  directipru,  and  leave  the  trailer  bed  surface.  The 
chassis  model  is  fastened  to  ^e  tri^er  bed  by  deformable  chain  models.  The  high  resolution 
vehicle  model  was  used  in  lieu  of  a  dummy  load  because  its  suspension  compliance  significantly 
^ects  the  transient  loads  generated  in  the  trailer  suspension  and  overall  system  toll  stability. 

The  tractor  model,  with  23  dof  is  a  fully  functional  stand>alone  system  composed  of  58  rigid 
bodies  (chassis.  30  suspension  elements.  4  steering  bubs,  8  wheels.  13  steering  linkages  and  2 
fifth  wheel  f^es.)  78  joints  and  20  clo^  kinematic  loops.  The  tractor  chassis  outline  was  not 
shown  on  the  g^hica!  im^e.in  Fig.  6  to  provide  a  better  view  of  the  suspension  and  steering 
models  as.  it,  negotiates  a  0.3  ihe^  rainp  (the  tractor  is  heading  to  the  right.)  Each  suspension  is 
composed  of  a  control  atih.p^  connected  to  a  control  hub.  The  front  suspensions  are  supported 
by  fore-aft  torsion  ban  connected  betw]^  the  control  arms  iuid  chassis  as  shown  in  the  figure, 
liie  rear  suspenrions'afe  supporied  by  pivoting  walking  beams.  A  pitman  arm  shown  in  the  upper 
right  h^d  corner  provides  steering  iriput  to  die  system  through  the  steering  kinematic  linkages. 

the  triuler  tn^ei.  with  29  dot  is;a  fully  functioi^  stand-alone  system  composed  of  49  rigid 
bodies  (cluusis,  36  supension  elemjMts  and  12  wheels.)  59  joints  and  10  closed  kinematic  loops. 
Pari  of  the  u^er  d^is-oudihe  Was  not  shown  bn  the  graphical  iihage  in  Fig.  7  to  provide  a 
better  view  of  the  suspension  as  it  negotiates  a  0.25  meter  bole  (the  trajleris  heading  to  the  left.) 
The  suspension  is  composed  of  two  main  beams  that  piVbt  on  the  chassis  above  axles  2  and 
support  axles  3.  Two  secondary  beams  pivot  oh  the  main  beams  and  support  axles  1  and  2.  The 
main  suspension  cylinders  move  vertically  relative  to  the  chassis  and  are  connected  to  transverse 
.ules  that  can  rotate  aruiind  fore-oft  axes  to  equalize  loads  on  the  tires.  The  beams  are  connected 
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Figure  7.  Cutaway  view  of  the  tiuler  suapensioh  as  it  negotiates  a  0.2S  meter  hole. 
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